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《机 器 人 手册 第 2 卷 机 器 人 技术 》 共 分 3 篇 ， 详 细 介绍 了 机 器 人 的 传 感 与 感知 、 操 
作 与 接口 、 移 动 式 和 分 布 式 机 器 人 技术 。 

传 感 与 感知 篇 介绍 用 于 生成 机 器 人 模型 及 外 部 环境 的 机 器 人 的 不 同感 觉 形 态 和 跨 时 空 传 
感 数 据 整 合 。 包 括 力 和 触觉 传感器 、 惯 性 传感器 、 全 球 定位 系统 和 里 程 仪 、 声 呐 感 测 、 距 离 
传感器 、 三 维 视觉 及 识别 、 视 觉 伺 服 与 视觉 跟踪 、 多 传感器 数据 融合 。 

操作 与 接口 篇 介绍 了 机 器 人 与 物体 之 间 ， 机 器 人 与 人 之 间 ， 机 器 人 之 间 的 交互 。 涵 盖 了 
面向 操作 任务 的 运动 、 接 触 环 境 的 建 模 与 作业 、 抓 取 、 合 作 机 械 手 、 触 觉 学 、 遥 操作 机 器 
人 、 网 络 遥 操作 机 器 人 及 人 体 机 能 增强 型 外 骨骼 。 

移动 式 和 分 布 式 机 器 人 篇 介绍 了 轮 式 机 器 人 运动 控制 、 运 动 规划 和 避 障 、 环 境 建 模 、 同 时 定 
位 与 建 图 、 基 于 行为 的 系统 、 分 布 式 和 单元 式 机 器 人 、 多 机 器 人 系统 及 网 络 机 器 人 技术 。 

本 手册 内 容 深 入 浅 出 ， 并 附 有 大 量 的 科研 实例 ， 便 于 自学 和 应 用 ， 可 作为 机 圳 人 、 人 工 
智能 、 自 动 化 、 控 制 以 及 计算 机 应 用 等 专业 科研 人 员 、 高 校 师 生 的 参考 用 书 ， 也 可 作为 相关 
专业 本 科 生 或 研究 生 的 参考 教材 ， 还 可 供 机 器 人 业余 爱好 者 参考 。 
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作者 序 一 


我 对 机 器 人 学 的 首次 了 解 是 源 自 1964 年 的 一 个 电话 。 打 电话 的 人 是 
Fred Terman， 世 界 著名 的 《无 线 电 工程 师 手 册 》 的 作者 ， 当 时 任 斯 坦 福 
大 学 教务 长 。Terman 博士 告诉 我 计算 机 科学 教授 John McCarthy 刚 获得 一 
大 笔 研究 经 费 ， 其 中 的 一 部 分 将 用 于 开发 计算 机 控制 的 机 械 怖 。 有 人 向 
Terman 建议 ， 如 果 以 数学 为 方向 的 McCarthy 教授 和 机 械 设 计 师 联手 ， 这 
将 会 是 很 聪明 的 做 法 。 由 于 我 是 斯 坦 福 教员 中 唯一 有 机 械 设计 专长 的 人 ， 
Terman 打算 给 我 打 个 电话 ， 尽 管 我 们 从 未 谋面 ， 而且 我 还 是 个 刚刚 研究 
生 毕 业 、 在 斯 坦 福 只 工作 了 两 年 的 年 轻 助理 教授 。 

Terman 博士 的 电话 使 我 与 John McCarthy 和 他 创建 的 斯 坦 福 人 工 智 能 


实验 室 (SAIL) 有 了 紧密 的 联系 。 机 器 人 成 了 我 整个 学 术 生 涯 的 支柱 ， Bernard Roth 
直到 今天 ， 我 一 直 保持 着 对 这 一 主题 的 教学 与 研究 兴趣 。 美国 斯 坦 福 大 学 机 械 工程 教授 


机 器 人 控制 的 近代 历史 要 追溯 到 20 世纪 40 年 代 后 期 ， 当 时 人 向 服 控 
制 的 机 械 臂 被 开发 出 来 ， 它 与 主 从 方式 的 机 械 臂 连接 起 来 被 用 于 处 理 核 物质 ， 从 而 保护 相关 人 员 。 这 一 领域 的 
发 展 一 直 延 续 到 现在 。 然 而 在 20 世纪 60 年 代 初 期 ， 还 很 少 有 关于 机 器 人 学 的 学 术 活 动 和 商业 活动 。 首 个 学 术 
活动 是 1961 年 麻 省 理工 学 院 H. A. Ernst 的 论文 。 他 用 装 有 触觉 传感器 的 从 动机 械 避 在 计算 机 控制 下 工作 。 他 
的 研究 思想 就 是 利用 触觉 传感器 中 的 信息 来 引导 机 械 臂 运动 。 

之 后 斯 坦 福 人 工 智能 实验 室 随 之 开展 了 相关 项 目 ， 麻 省 理工 学 院 Marvin Minsky 教授 也 启动 了 类 似 的 项 目 ， 
这 些 研 究 在 当时 是 在 机 器 人 学 领域 为 数 不 多 的 学 术 置 险 。 这 些 尝试 中 的 少数 是 在 商业 机 械 臂 方面 ， 大 部 分 与 汽 
车 工业 生产 相 联系 。 在 美国 ， 在 汽车 工业 中 对 两 种 不 同 的 机 械 民 设计 进行 了 实验 : 其 中 一 种 来 自 AMF 公司 ， 
另 一 种 来 自 Unimation 公司 。 

另外 还 有 一 些 制 造成 手 、 腿 和 和 臂 部 假肢 的 机 械 装 置 ， 不 久之 后 ,为 了 提高 人 的 能 力 还 出 现 了 外 骨骼 装置 。 
那 时 还 没有 微 处 理 器 ， 所 以 这 些 装 置 既 不 受 计算 机 控制 ， 也 不 受 远 程 的 所 谓 微机 所 遥控 ， 更 不 用 说 大 型 计算 机 
控制 了 。 

最 初 ， 计 算 机 科学 领域 中 的 一 些 人 认为 计算 机 已 足够 强大 ， 可 以 控制 任何 机 械 设备 ， 并 使 其 完美 执行 。 但 
我 们 很 快 发 现 并 非 如 此 。 我 们 分 两 条 路 线 进行 。 其 一 是 为 斯 坦 福 人 工 智能 实验 室 (SAIL) 开发 特殊 设备 装置 ， 
以 保证 刚刚 起 步 的 机 器 人 团队 开展 实验 达到 硬件 证 明 与 概 您 验证 系统 。 另 一 条 路 线 或 多 或 少 与 斯 坦 福 人 工 智 能 
实验 室 的 工作 相关 ， 是 发 展 机 器 人 的 基础 机 械 科学 。 我 有 一 种 强烈 的 感觉 ， 可 能 会 发 展 出 一 项 有 意义 的 科学 。 
我 们 最 好 从 基本 概念 的 方面 思考 ， 而 不 是 专门 集中 在 特定 的 设备 上 面 。 

幸运 的 是 ， 两 种 路 线 竞 然 相互 间 非 常 和 谐 融 治 。 更 重要 的 是 ,研究 者 们 对 这 一 领域 的 研究 很 感 兴趣 。 硬 件 
开发 为 更 多 的 基本 概念 提供 了 有 具体 的 例证 ,研究 者 们 能 够 同时 开发 硬件 和 理论 。 
起 初 ， 为 了 尽快 开始 研究 ， 我 们 购买 了 一 只 机 械 避 。 在 洛杉矶 的 Rancho Los Amigos 医院 有 人 在 销售 一 种 
开关 控制 型 电动 机 了 驱动 的 外 骨骼 机 械 辟 ， 用 来 帮助 那些 怖 部 失去 肌肉 的 患者 。 我 们 购买 了 一 台 ， 把 它 连 接 在 
PDP-6 型 分 时 计算 机 上 。 这 大 ,设备 被 命名 为 “奶油 手指 ”， 它 是 我 们 的 第 一 个 实验 机 器 人 。 一 些 电 影展 示 的 视 
觉 反 馈 控 制 、 扒 探 任务 和 避 障 都 是 由 这 人 台 机 器 人 作为 明星 演员 完成 的 。 

第 一 个 由 我 们 自主 设计 的 操纵 器 被 简单 认为 是 “水 压 臂 ” 。 正 如 它 的 名 字 所 指 ， 它 是 由 水 力 驱动 的 。 要 建 
立 一 个 非常 快 的 手臂 ， 我 们 设计 了 特殊 的 旋转 驱动 器 ， 这 个 手臂 工作 得 非常 好 。 它 成 为 了 最 早 测 试 机 器 人 和 手 丑 
的 动态 分 析 和 时 间 最 优化 控制 的 实验 平台 。 然 而 ， 当 时 普遍 来 说 ， 计 算 、 规 划 和 传 感 性 能 都 很 有 限 ， 由 于 设计 
速度 比 要 求 速度 快 得 非常 多 ， 使 得 这 项 技术 的 应 用 很 受 限 制 。 

我 们 尝试 去 开发 一 个 真正 的 数字 化 手 怖 。 从 而 产生 了 一 个 蛇 形 结构 ， 取 名 为 Om (挪威 语 中 的 蛇 ) Orm 
有 若干 节 ， 每 节 有 膨胀 的 气动 驱动 器 阵列 ， 它 们 要 么 完全 伸展 ， 要 么 完全 收缩 。 基 本 思想 是 ; 虽然 在 工作 空间 
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中 Orm 仅 可 达到 有 限 数量 的 位 置 ， 但 是 如 果 达 到 的 位 置 有 很 多 ， 那 么 这 也 是 足够 的 。 一 个 经 过 概念 验证 的 小 
型 原型 Orm 被 开发 出 来 ， 然 而 我 们 发 现 这 种 类 型 的 手臂 不 能 用 于 斯 坦 福 人 工 智 能 实验 室 团队 。 

我 们 实验 室 第 一 个 真正 具有 功能 的 手臂 是 由 当时 的 研究 生 Victor Scheinman 设计 的 ， 它 就 是 非常 成 功 的 
“斯 坦 福 手 臂 ” 。 有 十 几 个 这 种 手臂 作 为 研究 工具 用 于 不 同 的 大 学 、 政 府 和 工业 实验 室 。 它 有 六 个 独立 驱动 关 
节 ， 均 由 计算 机 控制 的 直流 伺服 电动 机 驱动 。 其 中 一 个 关节 是 棱柱 的 ， 另 外 五 个 是 旋转 的 。 

鉴于 “奶油 手指 ”的 几何 学 需要 逆 运 动 学 的 迭代 解 ， 因 此 选择 “斯 坦 福 手 展 ” 的 几何 构 型 ， 即 可 以 通过 
编程 获得 其 逆 运 动 学 的 迭代 解 ， 应 用 起 来 简单 而 高 效 。 而 且 ， 这 个 机 械 设 计 是 特别 制作 的 ， 以 兼容 分 时 计算 机 
控制 固有 的 局 限 性 。 不 同 的 末端 执行 器 被 连接 到 机 械 避 末端 作为 手 。 在 我 们 的 版 本 中 ， 手 被 做 成 钳 夹 的 形式 ， 
还 有 两 只 滑动 手指 ， 两 只 手指 由 一 台 伺服 驱动 器 驱动 ， 因 此 ， 手 臂 的 实际 自由 度数 目 有 7 个 。 它 也 有 一 个 特别 
设计 的 六 轴 腕 部 力 传感器 。Victor Scheinman 继续 开发 了 其 他 重要 的 机 器 人 : 首先 是 一 个 有 六 个 旋转 关节 的 小 
型 仿 人 手臂 。 最 初 设 计 是 由 麻 省 理工 学 院 人 工 智 能 实验 室 Marvin Minsky 资助 的 。Victor Scheinman 建立 了 
Vicarm 公司 ， 这 是 一 家 小 公司 ， 为 其 他 实验 室 制 造 了 这 个 手臂 和 “斯 坦 福 手 臂 ”。Vicarm 后 来 成 为 了 Unimation 
公司 的 西海 岸 分 部 ， 在 那里 ， 通 过 Unimation 公司 在 通用 电机 公司 资助 下 他 设计 了 PUMA FUR. JE, 
Scheinman 为 Automatix 公司 开发 了 全 新 的 Robot World 多 机 器 人 系统 。 在 Scheinman 离开 Unimation 后 ， 他 的 同 
事 Brian Carlisle 和 Bruce Shimano 重组 了 Unimation 公司 的 西海 岸 分 部 Adept 公司 ， 该 公司 现在 是 美国 最 大 
的 装配 机 器 人 制造 商 。 

很 快 ， 精 密 机 械 和 电子 设计 、 优 化 的 软件 ， 以 及 完整 系统 集成 的 现代 化 趋势 成 为 常态 。 到 现在 ， 这 些 结合 
是 最 高 级 机 器 人 装置 的 标志 。 这 是 在 “机 械 电子 ”( 又 译 “ 机 电 一 体 化 ”或 “电子 机 械 ”，mechatronic) d 
的 基本 概念 。“ 机 械 电 子 ” 这 个 词 发 源 于 日 本 ， 它 代表 机 械 和 电子 两 个 词 的 串联 。 依 赖 于 计算 的 机 械 电 子 ， 
如 我 们 今天 所 知 的， 是 机 器 人 固有 技术 的 实质 。 

随 着 机 器 人 技术 在 全 世界 的 发 展 ， 很 多 人 开始 在 与 机 器 人 相关 的 领域 工作 ， 一 些 特有 的 附属 专业 得 到 了 发 
展 。 首 先 最 大 的 分 化 是 进行 机 械 避 工作 的 人 和 视觉 系统 工作 的 人 。 早 期 ， 视 觉 系统 在 给 出 机 器 人 周围 环境 的 信 
息 方面 看 起 来 比 其 他 方法 更 有 前 途 。 

视觉 系统 是 通过 摄像 机 来 捕获 周围 物体 的 图 片 ， 然 后 使 用 计算 机 算法 对 图 像 进 行 分 析 ， 从 而 推断 出 物体 的 
位 置 、 方 位 和 其 他 特性 。 图 像 系统 最 初 的 成 功 在 于 解决 定位 障碍 物 问 题 、 解 决 物体 操作 问题 和 读 取 装配 工程 
图 。 人 们 感到 视觉 用 于 与 工厂 自动 化 和 太空 探索 有 关 的 机 器 人 系统 中 具有 很 大 潜力 。 这 致使 人 们 开始 研究 可 以 
通过 视觉 系统 识别 机 器 零件 (特别 对 于 部 分 封闭 的 零件 ， 发 生 在 所 谓 的 “ 拾 箱 ” 问 题 中 ) 和 形状 不 规则 的 碎 
石 的 软件 。 
在 “看 ”和 移动 物体 的 能 力 被 建立 以 后 ， 下 一 个 合理 的 需要 就 是 让 机 器 人 做 一 系列 事件 的 规划 、 去 完成 
一 项 复杂 的 任务 。 这 使 得 规划 的 发 展 成 为 机 器 人 技术 非常 重要 的 分 支 。 在 固定 的 环境 中 制定 固定 的 计划 相对 来 
说 是 很 直接 的 。 然 而 ， 在 机 器 人 技术 中 ， 面 临 的 挑战 之 一 就 是 ， 由 于 误差 或 者 未 计划 的 事件 ， 环 境 发 生 了 未 预 
料 到 的 变化 ， 此 时 ， 机 器 人 会 发 现 环 境 的 变化 并 且 修 改 自 身 的 行动 。 在 此 领域 的 一 些 里 程 碑 事件 是 通过 使 用 一 
台 叫 做 Shakey 的 车 辆 来 开展 的 ， 开 始 于 1966 年 ， 由 斯 坦 福 研究 所 (现在 称 为 SRI) 的 Charlie Rosen 小 组 开发 。 
Shakey 有 一 人 台 摄 像 机 、 上 距离 探测 器 、 砸 撞 传 感 器 ， 通 过 无 线 电 和 视频 连接 到 DEC PDP-10 和 PDP-15 计算 机 上 。 

Shakey 是 第 一 台 可 以 思考 自己 行动 的 移动 机 器 人 。 它 利用 程序 获得 独立 感知 、 周 围 环境 模仿 和 产生 动作 的 
能 力 。 低 级 别 的 操作 程序 负责 简单 的 移动 、 转 动 和 路 径 规划 。 中 级 别 的 操作 程序 包含 若干 个 低级 别 程序 ， 可 以 
完成 更 复杂 的 任务 。 最 高 级 的 操作 程序 能 够 制定 和 执行 计划 来 实现 用 户 提出 的 高 级 目标 。 

视觉 系统 对 于 导航 、 物 体 定 位 和 确定 它们 之 间 的 相对 位 置 与 方位 非常 有 用 。 然 而 ， 当 在 具有 环境 约束 力 的 
地 方 ， 对 于 装配 零件 或 者 与 其 他 机 器 人 一 起 工作 ， 只 有 视觉 系统 通常 是 不 够 的 。 因 而 产生 了 一 种 需求 : 对 环境 
施加 到 机 器 人 上 的 力 和 力矩 进行 测量 ， 并 利用 测量 结果 来 控制 机 器 人 的 行动 。 多 年 以 来 ， 力 控制 操作 成 为 了 斯 
坦 福 人 工 智能 实验 室 和 遍布 世界 的 其 他 几 个 实验 室 的 主要 研究 课题 之 一 。 力 控制 在 工业 实践 中 的 使 用 始终 落后 
于 该 领域 的 研究 发 展 。 这 是 由 于 尽管 高 级 的 力 控制 系统 对 于 通用 的 操作 问题 非常 有 效 ， 但 限制 非常 苛刻 的 工业 
环境 的 特殊 问题 经 常 只 能 在 有 限 的 力 控制 甚至 没有 力 控 制 时 解决 。 

在 20 世纪 70 年代， 行走 机 器 、 机 械 手 、 自 动 汽车 、 多 传感器 信号 融合 和 恶劣 环境 设计 等 专门 领域 开始 快 
速 发 展 。 今 天 有 大 量 的 、 不 同 的 以 机 器 人 为 主题 的 专门 性 研究 ， 其 中 有 一 些 是 经 典 的 工程 学 科 领 域 ， 如 运动 
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学 、 动 力学 、 控 制 学 、 机 器 设计 、 拓 扑 学 和 轨迹 规划 。 每 一 个 学 科 在 研究 机 器 人 技术 之 前 都 已 经 走 过 了 一 上 段 漫 
长 的 路 程 ， 而 为 了 发 展 机 器 人 系统 和 应 用 ， 每 一 个 学 科 已 成 为 深入 研究 机 器 人 技术 的 一 个 方面 。 

在 理论 正在 发 展 的 同一 时 间 里 ， 工 业 机 器 人 ， 尽 管 稍微 有 些 分 离 ， 也 有 了 并 行 的 发 展 。 在 日 本 和 欧洲 ， 商 
业 开 发 强劲 ， 美 国 也 相继 发 展 。 相 关 的 工业 协会 纷纷 成 立 〈 日 本 机 器 人 协会 在 1971 年 3 月 成 立 ， XE Le 
人 工业 协会 (RIA) 在 1974 年 成 立 ) ， 定 期 举行 协会 展览 会 ， 并 召开 了 应 用 导向 的 技术 会 议 。 其 中 最 重要 的 有 
工业 机 器 人 国际 研讨 会 (ISIR) 、 工 业 机 器 人 技术 会 议 (现在 称 为 工业 机 器 人 技术 国际 会 议 (ICIRT) ) UREA 
际 机 器 人 和 视觉 展览 与 会 议 (这 是 由 RIA. 每 年 举办 的 贸易 展览 会 ) 。 

第 一 个 定期 的 系列 会 议 在 1973 年 召开 。 它 强调 机 器 人 技术 的 各 个 研究 方面 ， 而 不 仅仅 是 工业 上 的 。 它 由 
在 意大利 鸟 迪 内 的 机 械 科技 国际 中 心 (CISM) 和 机 械 与 机 器 理论 国际 联合 会 (IFToMM) 共同 赞助 (尽管 
IFToMM 仍 在 使 用 ,但 是 意义 已 经 变 为 机 械 与 机 器 科学 促进 国际 联合 会 )。 该 会 议 的 名 称 是 机 器 人 与 机 械 辟 的 
理论 与 实践 大 会 (RoManSy) ， 明 显 特征 是 强调 机 械 科学 和 来 自 东 欧 、 西 欧 ， 还 有 北美 和 日 本 的 科研 人 员 们 的 
职 极 交流 、 分 享 成 果 ， 会 议 现 在 仍然 每 半年 举行 一 次 。 在 我 个 人 的 笔记 里 ， 就 是 在 RoManSy SNE, RAK 
遇 到 了 这 本 手册 的 各 位 编辑 : 1978 年 遇 到 了 Khatib 博士 ，1984 年 遇 到 了 Siciliano 博士 。 他 们 当时 都 是 学 生 : 
Bruno Siciliano 攻读 他 的 博士 学 位 已 经 差不多 一 年 了 ，Oussama Khatib 那 时 刚刚 完成 了 他 的 博士 学 位 研究 。 两 个 
事件 ， 都 让 人 产生 一 见 钟情 的 感觉 ! 

众多 其 他 新 的 会 议和 研讨 会 迅速 加 入 到 RoManSy 里 面 。 如 今 ， 每 年 有 大 量 机 器 人 研究 导向 的 会 议 在 许多 
国家 举行 。 当 前 ， 最 大 型 的 会 议 是 一 般 吸引 了 超过 1000 位 参 会 者 的 IEEE 机 器 人 与 自动 化 国际 会 议 (ICRA), 

在 20 世纪 80 年 代 初期 ，Richard Paul 撰写 了 美国 第 一 本 真正 关于 机 器 人 操作 的 教材 《机 器 人 操作 一 一 数 
学 、 编 程 与 控制 》 出 版 社 (Richard P. Paul，MIT，1981) 。 它 把 经 典 力学 学 科 的 理论 应 用 到 机 器 人 领域 。 另 外 ， 
书 中 有 一 些 主题 是 从 他 在 斯 坦 福 人 工 智 能 实验 室 的 论文 研究 中 直接 发 展 而 来 (在 书 里 面 ， 许 多 例子 基于 
Scheinman 的 “斯 坦 福 手臂 ”。) Paul 的 书 是 美国 的 一 个 里 程 碑 事件 ， 它 为 将 来 一 些 有 影响 力 的 教材 开创 了 一 
个 模式 ， 还 鼓励 众多 的 大 学 与 学 院 开 设 专门 的 机 器 人 课程 。 

差不多 与 此 同时 ， 一 些 新 的 期 刊 创刊 ， 这 些 期 刊 主要 发 表 机 器 人 相关 领域 的 论文 。 在 1982 年 的 春天 ,《 机 
器 人 研究 国际 期 刊 》 创 刊 ， 三 年 之 后 , (IEEE 机 器 人 与 自动 化 期 刊 》( 现 在 的 《IEEE 机 器 人 学 报 》) 创刊 。 

随 着 微 处 理 器 的 普及 ， 关 于 什么 是 或 什么 不 是 机 器 人 的 问题 更 加 凸显 出 来 。 在 我 的 脑海 里 ， 这 个 争论 从 来 
没有 被 很 好 地 解决 过 。 我 认为 永远 不 会 有 一 个 大 家 都 普遍 同意 的 定义 。 当 然 ， 存 在 着 科幻 小 说 中 各 种 各 样 的 外 
太空 生物 和 戏院 、 文 学 以 及 电影 中 的 机 器 人 。 早 在 工业 革命 之 前 ， 就 有 过 想象 中 的 类 似 机 器 人 生物 的 例子 ， 但 
实际 的 机 器 人 又 会 是 什么 样 的 呢 ? 我 认为 关于 机 器 人 的 定义 实质 上 是 一 个 随 着 科技 进步 而 不 断 改变 其 本 体 特征 
的 移动 部 。 例 如 当 船 上 的 陀螺 仪 自动 罗 副 第 一 次 被 开发 出 来 时 就 被 认为 是 一 个 机 器 人 。 现 在 ， 当 我 们 罗列 在 我 
们 世界 中 的 机 器 人 的 时 候 ， 总 是 无 法 完全 赛 括 所 有 的 机 器 人 。 机 器 人 的 定义 已 经 被 降级 了 ， 现 在 机 器 人 被 看 做 
是 一 种 自动 控制 装置 。 

对 于 很 多 人 来 说 ， 机 器 人 包含 着 多 功能 的 概念 ， 机 器 人 即 意味 着 在 设计 和 制造 时 就 具备 了 容易 适应 或 者 可 
被 重新 编程 以 完成 不 同 任务 的 能 力 。 在 理论 上 ， 这 种 想法 应 该 可 以 实现 的 ， 但 在 实际 中 ， 却 是 大 多 数 的 机 器 人 
装置 只 能 在 非常 有 限 的 领域 里 实现 多 功能 。 人 们 很 快 发 现 ， 在 工业 中 一 般 而 言 ， 一 台 具 有 专门 用 途 的 机 器 要 比 
一 合 具 有 广泛 用 途 的 机 器 表现 好 得 多 。 而 且 在 制造 加 工时 ， 当 产品 的 产量 足够 高 的 时 候 ， 一 侣 具有 专门 用 途 的 
机 器 要 比 一 台 具 有 广泛 用 途 的 机 器 花费 少 。 因 此 ， 人 们 开发 出 专业 机 器 人 用 于 喷漆 、 锦 接 、 零 部 件 装配 、 压 力 
加 载 、 电 路 板 填充 等 方面 。 在 一 些 情况 下 ， 机 器 人 被 用 于 如 此 专 一 的 用 途 ， 以 至 于 很 难 划 清 一 台所 谓 的 机 器 人 
与 一 条 可 调整 的 “固定 的 ”自动 化 流水 线 的 界限 。 人 们 理想 中 的 机 器 人 应 该 是 能 做 “所 有 事 ” 的 万 能 机 器 ， 
忆 此 这 种 机 器 人 在 大 量 出 售 以 后 价格 将 相对 便宜 。 但 是 ， 许 多 机 器 人 的 实际 情况 则 恰好 与 之 相反 。 

我 认为 机 器 人 的 概念 应 该 与 在 给 定 的 时 间 内 什么 活动 是 与 人 相关 ， 以 及 什么 活动 是 与 机 器 相关 联系 起 来 。 
如 果 一 人 台 机 器 突然 变 得 能 够 完成 我 们 通常 和 人 联系 在 一 起 的 工作 时 ， 这 人 台 机 器 就 能 在 定义 上 被 提升 而 定义 为 一 
个 机 器 人 。 过 了 一 段 时 间 以 后 ， 人 们 习惯 于 这 件 工作 由 机 器 来 完成 了 ， 这 个 装置 就 从 “机 器 人 ”降级 为 “机 
器 ”。 那 些 没有 固定 底座 和 那些 具有 用 膊 或 腿 状 附件 的 机 器 人 更 有 优势 ， 也 更 有 可 能 被 称 作 机 器 人 ， 但 是 很 难 
让 人 想到 一 套 始 终 如 一 的 定义 标准 ， 并 适合 目前 所 有 的 命名 惯例 。 

在 包括 家 用 机 器 的 所 有 机 器 中 ， 拥 有 微 处 理 器 来 指导 其 行动 的 都 可 以 认为 是 机 器 人 。 除 了 真空 吸尘器 ， 还 


VI 作者 序 一 


有 洗衣 机 、 冰 箱 以 及 洗 碗 机 都 能 很 容易 地 作为 机 器 人 被 推 向 市 场 。 当 然 ， 还 存在 着 很 多 的 可 能 性 ， 包 括 那 些 具 
有 环境 感知 反馈 和 判断 能 力 的 机 器 。 在 实践 里 ， 那 些 被 看 做 是 机 器 人 的 装置 中 ， 传 感 器 的 数量 和 判断 能 力 可 能 
由 很 多 、 很 强 一 直 变 化 到 完全 没有 。 

在 最 近 的 几 十 年 里 ， 对 机 器 人 的 研究 已 经 由 一 个 以 机 电 人 整合 装置 研究 为 中 心 的 学 科 壮 大 为 一 个 宽广 得 多 的 
交叉 性 学 科 。 被 称 作 以 人 为 本 的 机 器 人 领域 便 是 这 样 的 一 个 合子。 在 这 个 领域 里 ， 人 们 研究 人 和 智能 机 器 的 相 
互 作用 。 这 是 一 个 发 展 中 的 领域 ， 其 中 ， 对 机 器 人 与 人 的 相互 影响 的 研究 已 经 吸引 了 来 自 经 典 机 器 人 研究 领域 
之 外 的 专家 们 。 人 们 正在 研究 一 些 诸如 人 和 机 器 人 的 情感 之 类 的 概念 ; 而 且 一 些 像 人 体 生理 学 和 生物 学 等 古老 
的 研究 领域 正在 被 合并 成 机 器 人 研究 的 主流 。 这 些 研究 活动 将 新 的 工程 和 科学 层面 引进 到 了 研究 著述 中 ， 从 而 
丰富 了 机 器 人 研究 领域 。 

最 初 ， 初 期 的 机 器 人 界 主要 关注 让 机 器 去 干 活 。 对 于 那些 早期 的 机 器 人 装置 ， 人 们 完全 只 关注 它们 能 不 能 
干 活 ， 而 很 少 去 在 意 它们 有 限 的 性 能 。 现 在 ,我 们 拥有 精细 的 、 可 靠 的 装置 作为 机 器 人 系统 现代 阵列 的 一 训 
分 。 这 一 进步 是 全 世界 成 千 上 万 人 的 工作 成 果 ， 这 些 工作 很 多 都 是 在 大 学 、 政 府 的 研究 实验 室 和 企业 里 进行 
的 。 这 一 成 就 创造 了 包含 在 本 手册 64 章 中 的 大 量 的 信息 ， 这 是 对 全 世界 工程 界 和 科学 界 的 致敬 。 显 然 这 些 成 
果 并 非 由 任何 中 央 规 划 或 者 一 个 整体 有 序 的 计划 产生 。 因 此 本 手册 的 编者 面 对 着 将 这 些 材料 组 织 成 一 个 有 逻辑 
而 且 清 晰 明了 的 整体 的 艰巨 任务 。 

编辑 将 稿件 划分 为 三 层 结构 。 第 一 层 论述 这 门 学 科 的 基础 。 这 一 层 由 9 章 组 成 。 作 者 在 其 中 详细 讲述 了 机 
器 人 学 科 、 运 动 学 、 动 力学 、 控 制 学 、 机 构 学 、 架 构 、 编 程 、 推 理 和 传 感 。 这 些 是 组 成 机 器 人 研究 和 发 展 的 基 
本 技术 。 

第 二 层 有 四 个 部 分 。 第 一 部 分 (第 2 篇) 阐述 了 机 器 人 的 结构 ， 包 括 避 部 、 腿 、 手 和 其 他 大 多 数 机 器 人 
的 组 成 部 分 。 千 一 看 ， 腿 、 涡 部 和 手 这 些 硬件 可 能 相互 之 间 差 异 巨 大 ， 但 它们 共有 一 套 属 性 ， 使 他 们 能 够 用 相 
同 的 或 很 接近 的 、 在 第 一 层 中 描述 过 的 原理 去 分 析 。 

该 层 的 第 二 部 分 (第 3 篇 ) 涉及 传 感 和 感知 ， 它 们 是 任何 真正 独立 的 机 器 人 系统 所 必需 的 基本 能 力 。 正 
如 先前 指出 ， 实 际 上 许多 所 谓 的 机 器 人 设备 只 有 少量 的 上 述 能 力 ， 但 显然 更 先进 的 机 器 人 不 能 离开 它们 ， 并 且 
很 大 趋势 是 把 这 些 能 力 合并 到 机 器 人 设备 中 。 该 层 第 三 部 分 (第 4 篇 ) 讲述 了 这 门 学 科 领 域 和 设备 控制 与 接 
口技 术 的 联系 。 该 层 第 四 部 分 (第 5 篇 ) 由 8 章 组 成 ， 探 讨 了 移动 机 器 人 和 不 同形 式 的 分 布 式 机 器 人 。 

第 三 层 由 两 部 分 共 12 章 组 成 ， 涉 及 当今 研究 和 开发 前 沿 的 高 级 应 用 。 一 部 分 (9618) 论述 现场 和 服务 
机 器 人 ， 另 一 部 分 (第 7 篇 ) 讲述 以 人 为 本 和 仿真 机 器 人 。 对 于 外 行 读 者 ， 这 些 章节 是 先进 机 器 人 的 全 部 。 
然而 必须 意识 到 这 些 非 同 寻常 的 实现 如 果 没 有 前 两 层 所 介绍 的 发 展 ， 就 可 能 不 会 存在 。 

理论 和 实践 的 紧密 联系 促成 了 机 器 人 技术 的 发 展 ， 并 成 为 现代 机 器 人 的 一 种 特征 。 这 两 个 互补 的 方面 ， 对 
于 我 们 当中 那些 同时 拥有 机 会 研究 和 开发 机 器 人 设备 的 人 ， 是 个 人 成 就 感 的 源泉 。 本 手册 极 好 地 反映 了 学 科 的 
这 两 个 互补 方面 ， 并 展现 近 五 十 年 来 的 大 量 研究 成 果 。 一 些 人 将 要 发 明 更 有 能 力 的 多 样 的 下 一 代 机 器 人 设备 ， 
当然 ， 本 手册 的 内 容 将 作为 他 们 一 个 有 价值 的 工具 和 各 导 引 。 向 编辑 和 作者 致 以 祝贺 与 崇敬 。 


Bernard Roth 
美国 斯 坦 福 大 学 
2007 年 8 月 


VE A TF 


翻 开 这 本 手册 ， 纵 观 其 64 章 丰 富 的 内 容 ， 我 们 不 妨 从 个 人 的 视角 ， 对 机 
器 人 学 在 概念 、 趋 势 及 中 心 问题 等 方面 的 演变 作 一 个 概述 。 

现代 机 器 人 学 大 约 开始 于 半 个 世纪 以 前 ， 并 向 两 个 不 同 的 方向 发 展 。 

首先 ， 让 我 们 了 解 一 下 机 械 民 涉及 的 范围 ， 从 对 遭受 辐射 污染 产品 的 远 
程 作业 到 工业 机 械 手 ， 无 不 包含 在 其 领域 中 ， 而 这 之 中 标志 性 机 器 UNIMATE 
是 通用 机 械 手 的 代表 。 产 品 的 工业 发 展 ， 大 多 围绕 六 自由 度 串 联 图 景 以 及 积 
极 的 研究 和 开发 ， 将 机 械 工程 与 控制 专业 化 联系 在 一 起 ， 成 为 其 发 展 的 主要 
推动 力 。 当 今 特 别 值得 关注 的 是 ， 通 过 对 先进 的 功能 强大 的 数学 工具 的 运用 ， 
在 新 颖 的 应 用 优化 结构 设计 方面 的 努力 终于 获得 了 回报 。 类 似 的 ， 为 实现 制 


造 出 与 人 类 友好 的 机 器 人 的 梦想 ， 一 项 关于 未 来 认 知 机 器 人 的 先 和 和 手 的 设计 Georges Giralt 

与 实际 建造 也 引起 了 人 们 的 重视 。 法 国 拉 斯 -国家 科学 研究 中 心 
其 次 ， 还 未 被 人 类 充分 认识 但 我 们 应 该 清楚 的 是 涉及 人 工 智能 相关 主题 (LAAS- CNRS) 研究 主管 ， 

的 系列 工作 。 在 此 领域 中 具有 里 程 碑 意 义 的 项 目 便 是 斯 坦 福 国际 集团 开发 的 图 卢 效 

移动 机 器 人 Shakey。 这 项 旨 在 集 计算 机 科学 、 人 工 智能 和 应 用 数学 于 一 身 发 

展 智能 机 器 的 工作 ， 至 今 作为 一 个 子 领域 已 经 有 一 段 时 间 了 。20 世纪 80 年 代 期 间 ， 通 过 对 围绕 包括 从 极端 环 


境 下 的 探测 器 (如 星球 探测 ， 南 极 洲 等 ) 到 服务 机 器 人 (如 医院 ， 博 物 馆 引导 等 ) 等 宽广 范围 的 个 案 研 究 获 
得 的 建设 强度 ， 引 发 了 大 范围 的 研究 ， 从 而 也 英 定 了 智能 机 器 人 的 地 位 。 

因此 机 器 人 学 的 研究 能 够 将 这 两 个 不 同 的 分 支 联系 起 来 ， 将 智能 机 器 人 以 一 种 纯粹 的 计算 方式 分 类 为 有 限 
理性 机 器 ， 这 是 在 20 世纪 80 年 代 第 三 代 机 器 人 定义 的 基础 上 进行 了 扩展 : 

< (机 器 人 ) se 作为 一 个 通过 智能 将 感知 和 行动 联系 在 一 起 ， 而 被 赋予 了 对 一 项 工作 拥有 理解 、 推 断 并 
执行 能 力 的 机 器 ， 在 三 维 的 世界 里 执行 操作 。” 

作为 一 个 广泛 认可 的 测试 平台 ， 自 主机 器 人 领域 最 近 从 机 器 人 设计 方面 的 突出 贡献 中 受益 颇 多 ， 而 这 些 贡 
献 是 通过 在 环境 建 模 及 机 器 人 定位 上 运用 算法 几何 及 随机 框架 法 (SLAM， 同 步 定位 和 建 模 ) ， 以 及 运用 贝 叶 
斯 估计 和 决策 方法 所 带 来 的 决策 程序 的 发 展 等 综合 取得 的 。 

在 千 祠 年 的 过 去 十 年 间 ， 机 器 人 学 主要 处 理智 能 机 器 人 图 景 ， 在 一 个 覆盖 了 先进 传 感 和 知觉 、 任 务 推理 和 
规划 、 操 作 和 决策 自动 化 、 功 能 性 整合 架构 、 智 能 人 机 接口 、 安 全 和 可 靠 性 等 项 目的 主题 内 ， 将 机 器 人 和 机 器 
智能 通用 研究 结合 起 来 。 

第 二 个 分 支 数 年 来 被 认为 是 非 制 造 机 器 人 学 的 ， 涉 及 大 量 有 关 现场 、 服 务 、 辅 助 以 及 后 来 的 个 人 机 器 人 
的 、 以 研究 为 驱动 的 真实 世界 的 案例 。 这 里 ， 机 器 智能 在 其 多 个 主题 内 是 中 心 研究 方向 ， 使 得 机 器 人 能 够 在 以 
下 三 个 方面 得 以 行动 : 

1) 作为 人 类 的 替代 者 ， 尤 其 是 对 于 远程 或 恶劣 环境 中 的 于 预 工作 。 

2) 通过 与 人 友好 机 器 人 学 或 以 人 为 本 机 器 人 学 的 所 有 实际 应 用 ,与 人 类 的 亲近 交互 及 在 人 类 环境 中 的 
操作 。 

3) 与 使 用 者 的 紧密 协同 ， 从 机 械 外 骨骼 辅助 、 外 科 手 术 、 保 健 和 康复 扩展 到 人 类 隆胸 。 

为 此 ， 在 千年 之 交 ， 机 器 人 学 已 经 成 为 一 个 广泛 的 研究 主题 ， 不 仅 有 对 于 工程 化 很 好 的 工业 领域 支持 市 场 
产品 ， 同 时 也 有 大 量 在 危险 环境 中 操作 的 领域 导向 的 应 用 案例 ， 如 水 下 机 器 人 、 复 杂 地 形 车 、 医 疗 / 康 复 机 器 
人 学 等 。 

机 器 人 学 的 发 展 水 平 重点 看 理论 方面 所 扮演 的 角色 ， 目 前 它 已 经 从 应 用 领域 发 展 到 技术 和 科学 的 领域 。 这 
本 手册 的 组 织 构架 很 好 地 阐释 了 这 些 不 同 的 水 平 。 此 外 ， 为 了 未 来 认 知 型 机 器 人 ， 除 了 大 量 的 软件 系统 ， 人 们 
还 需要 考虑 与 人 友好 的 环境 中 的 机 器 人 物理 性 质 和 新 奇 附件 ， 包 括 腿 、 怖 和 手 的 设计 。 


VIII 作者 序 二 


在 当前 千 禧 年 的 前 十 年 ， 前 沿 的 机 器 人 学 正在 取得 突出 的 进步 ， 通 常 由 以 下 两 个 方向 组 成 : 

1) 中 /短期 面向 应 用 的 案例 研究 。 

2) 中 /长 期 一 般 情况 的 研究 。 

为 了 完整 性 ， 我 们 需要 提 到 大 量 外 围 的 、 激 发 机 器 人 学 灵感 的 学 科 ， 这些 学 科 经 常 是 关于 娱乐 、 广 告 和 精 
致 的 玩具 。 

与 人 友好 机 器 人 学 的 前 没 领域 包括 几 个 一 线 的 应 用 领域 ， 在 这 些 领域 里 ， 机 器 人 (娱乐 、 教 育 、 公 共 服 
务 、 辅 助 和 个 人 机 器 人 等 ) 在 人 类 环境 或 者 在 和 人 类 密切 相互 作用 的 环境 里 运作 。 这 里 也 就 介绍 了 人 机 交互 
的 关键 性 问题 。 

正 是 在 这 个 领域 的 中 心 ， 浮 现 出 来 个 人 机 器 人 的 前 沿 的 课题 ， 对 此 ， 在 这 里 我 们 着 重 强调 它 的 三 个 总 体 
THE: 

1) 它们 可 能 由 非 专 业 使 用 者 操作 。 

2) 它们 可 能 被 设计 来 和 使 用 者 分 享 高 水 平 的 决定 。 

3) 它们 可 能 包含 环境 装置 和 机 器 附件 、 遥 远 的 系统 ， 还 有 操作 者 。 这 种 分 享 决策 的 观念 暗示 这 里 呈现 
一 些 前 沿 研究 课题 和 伦理 问题 。 

个 人 机 器 人 的 概念 ， 正 扩大 为 机 器 人 助手 和 万 能 “伴侣 ”， 对 于 机 器 人 学 来 说 确实 是 一 项 重大 的 挑战 。 机 
器 人 学 作为 科学 和 技术 领域 的 一 个 重要 分 支 ， 提 供 了 在 中 长 期 对 社会 和 经 济 产生 重大 影响 的 观念 。 这 里 介绍 和 
质疑 前 沿 课题 包括 以 下 认 知 的 方面 : 可 协调 的 智能 人 机 交互 、 感 觉 (场景 分 析 、 种 类 识别 ) 、 开 放 式 学 习 (了 
解 所 有 的 行为 ) 、 技 能 获取 、 大 量 的 机 器 人 世界 的 数据 处 理 、 自 主 决定 权 和 可 靠 性 (安全 性 、 可 靠 性 、 交 流 和 
操作 稳定 性 ) 。 

上 面 提 到 的 两 种 方法 有 很 明显 的 协同 性 ， 尽 管 必 要 的 框架 存在 时 差 。 这 种 科学 上 的 联系 不 仅 集合 了 问题 和 
获得 结果 ， 而 且 也 在 事物 两 方面 创造 出 和 谐 的 交流 和 给 技术 带 来 进步 。 

事实 上 ， 这 种 相应 的 研究 趋势 和 应 用 领域 的 发 展 获得 了 爆炸 性 的 实用 技术 的 支持 ， 其 中 包括 计算 机 处 理 能 
力 、 通 信 学 、 计 算 机 网 络 设计 、 传 感 装置 、 知 识 检索 、 新 材料 、 微 纳米 技术 。 

今天 ， 展 望 中 长 期 的 未 来 ， 我 们 正面 对 非常 积极 的 议题 和 观点 ， 但 是 也 必须 对 有 关机 器 人 的 批评 性 意见 和 
隐 存 的 风险 做 出 回应 ,这 种 风险 就 在 于 人 们 担心 机 器 人 在 和 人 接触 的 过 程 中 也 可 能 出 现 不 需要 的 或 者 不 安全 的 
行为 。 因 此 ， 存 在 一 个 非常 清晰 的 需求 ， 那 就 是 研究 级 别 安全 问题 和 可 靠 性 与 相应 的 系统 限制 课题 。 

《机 器 人 手册 》 的 出 版 非常 及 时 ， 充 满 了 挑战 性 的 成 果 。 它 由 165 位 作者 在 64 章 中 总 结 了 大 量 的 难题 、 问 
题 和 方方面面 。 就 其 本 身 而 言 ， 它 不 仅 是 全 世界 研究 者 所 获得 的 基本 课题 和 结果 的 一 个 高 效 展示 ， 而 且 和 进一步 
给 每 一 个 人 提供 了 不 同 的 观点 和 方法 。 这 确实 是 一 个 可 以 带 来 进步 的 很 重要 的 工具 ， 但 是 ， 更 重要 的 是 ， 它 将 
在 这 个 千 禧 年 的 头 二 十 年 成 为 建立 机 器 人 学 的 开端 ， 在 机 器 智能 的 核心 领域 成 为 科学 的 学 科 。 


EG 


Georges Giralt 
法 国 图 卢 效 
2007 年 12 月 


作者 序 三 


机 器 人 学 领域 诞生 于 20 世纪 中 期 ， 当 时 新 兴 的 计算 机 科学 正在 改变 科学 
和 工程 中 的 每 一 个 领域 。 机 器 人 学 经 历 了 不 同 的 阶段 ， 从 婴儿 期 ， 童 年 期 到 
青年 期 ， 再 到 成 年 期 ， 已 经 完成 了 快速 而 稳健 的 成 长 。 机 器 人 学 现在 已 经 成 
熟 ， 人 们 希望 它 在 未 来 的 社会 里 提高 他 们 的 生活 质量 。 

在 机 器 人 学 的 婴儿 期 ， 它 的 核心 被 认为 是 模式 识别 、 自 动 控制 和 人 工 管 
能 。 带 着 这 些 新 的 挑战 ， 这 个 领域 的 科学 家 和 和 工程师 聚 集 在 一 起 来 审查 新 奇 
的 机 器 人 传感器 和 驱动器、 规划 和 编程 算法 以 及 连接 各 部 分 组 件 的 最 优 结构 。 
在 此 过 程 中 ， 他 们 创造 出 在 真实 世界 中 可 以 和 人 进行 交互 作用 的 机 器 人 。 这 
些 旱 期 的 机 器 人 学 集中 于 研究 手 - 眼 系 统 ， 也 就 是 人 工 智能 研究 的 试验 平台 。 


“童年 时 期 ”机 器 人 的 活动 场地 是 在 工厂 。 工 业 机 器 人 被 研究 出 来 ， 并 Hirochika Inoue 
且 应 用 到 工厂 进行 自动 喷涂 、 点 焊 、 打 磨 、 材 料 操 作 和 零件 装配 。 拥 有 传 感 日 本 东京 大 学 教授 


器 和 记忆 功能 的 机 器 人 使 工厂 更 加 自动 化 ， 使 机 器 人 的 操作 更 加 和 柔性 化 、 更 

加 可 靠 和 精确 。 机 器 人 的 自动 化 将 人 从 繁重 和 乏味 的 体力 劳动 中 解放 出 来 。 汽 车 、 家 电 和 半导体 工业 迅速 将 其 
生产 线 重 整 为 机 器 人 集成 化 系统 。 英 文 单词 “机 械 电子 ”( 又 称 为 “机 电 一 体 化 "、“ 电 子 机 械 ”) 最 早 是 由 日 
本 人 在 20 世纪 70 年 代 末 期 提出 来 的 。 它 定义 了 一 个 新 的 机 器 观念 ， 在 这 种 观念 里 ， 电 子 和 机 器 系统 相 融 合 ， 
这 种 融合 使 很 多 工业 产品 变 得 更 加 简单 、 却 又 更 加 多 功能 ， 而 且 可 编程 和 智能 化 。 机 器 人 学 和 机 械 电子 学 在 制 
造 过程 的 设计 、 操 作 和 工业 产品 上 都 产生 了 非常 积极 的 影响 。 

随 着 机 器 人 学 进入 它 的 青春 期 ， 研 究 者 雄心 勃勃 地 去 探索 它 新 的 起 点 。 运 动 学 、 动 力学 和 系统 控制 理论 变 
得 更 加 精妙 ， 同 时 它们 也 被 应 用 到 真正 的 复杂 机 器 人 的 机 构 中 。 为 了 进行 规划 和 完成 真实 的 任务 ， 机 器 人 必须 
能 够 认 知 它 所 处 的 环境 。 视 觉 一 一 外 部 感觉 的 主要 的 途径 ， 作 为 机 器 人 了 解 其 所 处 外 部 环境 的 最 普通 、 最 有 效 
的 、 最 高 效 的 手段 ， 被 开发 出 来 。 已 经 发 展 起 来 的 高 级 的 算法 和 强 有 力 的 装置 将 会 用 来 提高 机 器 人 视觉 系统 的 
速度 和 稳定 性 。 触 觉 和 力 的 传 感 系统 也 需要 发 展 ， 这 样机 器 人 可 以 更 好 地 操控 物体 。 在 建 模 、 规 划 、 认 知 、 推 
理 和 记忆 方面 的 研究 扩大 了 机 器 人 的 智能 化 特性 。 机 器 人 学 逐渐 被 定义 为 传 感 和 驱动 之 间 的 智能 连接 的 研究 。 
这 种 定义 覆盖 了 机 器 人 学 的 所 有 方面 : 三 大 科学 核心 和 一 个 整合 它们 的 综合 方法 。 事 实 上 ， 由 于 系统 综合 使 仿 
生机 器 的 创造 成 为 可 能 ， 所 以 它 已 经 成 为 一 个 机 器 人 工程 的 关键 性 方面 。 创 造 这 种 仿生 机 器 人 的 乐趣 吸引 了 很 
多 学 生 投身 到 机 器 人 学 领域 。 

在 发 展 机 器 人 学 的 过 程 中 ， 科 学 的 兴趣 被 导向 到 去 理解 人 类 的 精妙 。 人 类 和 机 器 人 的 比较 研究 在 科学 研究 
人 的 功能 建 模 方面 开辟 出 了 一 条 新 路 。 认 知 机 器 人 学 、 仿 生 行 为 、 生 物 激发 的 机 器 人 和 机 器 人 生理 心理 学 方 
法 ， 在 扩大 机 器 人 潜力 方面 达到 了 极限 。 总 的 来 说 ， 在 科学 探索 中 ， 不 成 熟 的 领域 是 稀少 的 。20 世纪 80 和 90 
年 代 ， 机 器 人 学 就 处 于 这 样 一 个 年 轻 的 阶段 ， 它 吸引 了 大 量 充满 好 奇 心 的 研究 者 进入 这 个 新 的 前 沿 领域 。 他 们 
对 该 领域 持续 的 探索 形成 该 本 富 含 科学 内 容 的 综合 性 手册 。 

随 着 机 器 人 学 科 前 沿 知识 的 掌握 ， 进 一 步 的 挑战 为 我 们 打开 了 将 成 熟 的 机 器 人 技术 应 用 于 实际 的 大 门 。 早 
期 的 机 器 人 的 活动 空间 给 工业 机 器 人 的 场所 让 路 。 内 科 机 器 人 、 外 科 机 器 人 、 活 体 成 像 技 术 给 医生 做 手术 提供 
了 强 有 力 的 工具 ， 这 使 许多 病人 免 于 病痛 的 折磨 。 人 们 期 望 诸如 康复 、 卫 生 保健 、 福 利 领域 的 新 机 器 人 能 够 提 
高 老龄 化 社会 的 生活 质量 。 机 器 人 必 将 会 遍布 于 世界 的 每 一 个 角落 一 一 天 上 、 水 下 、 太 空中 。 人 们 和 希望 能 和 机 
器 人 在 农业 、 林 业 、 矿 业 、 建 筑 业 、 和 危险 环境 及 救援 中 联手 工作 ， 并 发 现 机 器 人 在 家 务 及 在 商店 、 饭 馆 、 医 院 
服务 中 的 实用 性 。 在 无 数 的 方式 中 ， 人 们 还 是 希望 机 器 人 可 以 支持 我 们 的 生活 。 然 而 ， 从 这 方面 来 看 ， 机 器 人 
的 应 用 主要 受到 结构 化 环境 的 限制 ， 在 这 些 环境 中 ， 出 于 安全 考虑 ， 机 器 人 和 人 是 相互 隔离 的 。 在 下 一 个 阶 
段 ， 机 器 人 所 处 的 环境 将 扩展 为 非 结 构 化 的 世界 ， 在 这 里 ， 人 享受 服务 ， 将 总 是 和 机 器 人 一 起 工作 和 生活 。 在 
这 样 的 环境 中 ， 机 器 人 将 必须 具备 高 性 能 的 传感器 、 更 加 智能 化 、 强 化 的 安全 性 和 更 好 的 人 类 理解 力 。 在 寻求 
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阻碍 机 器 人 发 展 问 题 的 解答 过 程 中 ， 不 仅 应 该 考虑 技术 上 的 问题 ， 还 应 该 考虑 社会 问题 。 

自从 我 最 初 的 研究 一 使 机 器 人 变 成 一 个 奇想 ， 到 现在 ， 四 十 年 已 经 过 去 了 。 从 最 开始 就 见证 了 机 器 人 技 
术 的 成 长 我 感到 幸运 和 高 兴 。 为 了 机 器 人 学 的 诞生 ， 从 其 他 学 科 引 进 了 基础 的 技术 。 没 有 教科 书 和 手册 是 现成 
的 。 为 了 达到 目前 的 这 个 阶段 ， 许 多 科学 家 和 工程 师 已 经 挑战 了 新 的 领域 。 在 推进 机 器 人 学 的 同时 ， 他 们 从 多 
维度 的 视角 丰富 了 知识 本 身 。 他 们 努力 的 成 果 都 已 经 编辑 在 这 本 机 器 人 手册 中 了 。 这 本 出 版 物 是 百 多 位 世界 领 
军 专家 共同 合作 的 结果 。 现 在 ， 那 些 希 望 投身 于 机 器 人 学 研究 的 人 就 能 够 找到 一 个 可 以 建构 自己 知识 体系 的 坚 
实 的 基础 。 这 本 手册 必 将 会 用 于 进一步 发 展 机 器 人 学 ， 强 化 的 工程 教育 和 系统 的 知识 编辑 可 以 促进 社会 和 工业 
的 知识 创新 。 

在 老龄 化 社会 里 ， 人 类 和 机 器 人 的 角色 是 科学 家 和 工程 师 需要 考虑 的 重要 问题 。 机 器 人 能 够 对 保卫 和 平 、 
促进 繁荣 和 提高 人 们 生活 质量 做 出 贡献 吗 ? 这 是 一 个 尚未 解决 的 问题 。 然 而 ， 最 近 个 人 机 器 人 、 家 用 机 器 人 和 
仿 人 机 器 人 的 进步 间接 表明 机 器 人 从 工业 部 门 到 服务 业 部 门 的 转移 。 为 了 实现 这 种 转移 ， 机 器 人 学 不 可 回避 这 
样 的 观点 ， 那 就 是 机 器 人 学 工作 的 基础 包含 了 社会 学 、 生 理 心 理学 、 法 律 、 经 济 、 保 险 、 伦 理 、 艺 术 、 设 计 、 
戏剧 和 运动 科学 。 将 来 的 机 器 人 学 应 该 被 作为 包含 人 类 学 和 技术 的 学 科 来 研究 。 这 本 手册 有 选择 地 提供 了 推进 
机 器 人 学 这 个 新 兴 科 学 领域 的 技术 基础 。 我 期 待机 器 人 学 持续 不 断 的 进步 ， 期 待 它 能 够 促进 未 来 社会 的 繁荣 。 


Hirochika Inoue 
日 本 东京 
2007 年 9 月 


机 器 人 已 经 
将 传 感 和 动作 联 
到 20 世纪 20 年 
界 并 能 恰当 工作 
了 对 真正 机 器 人 的 描述 
+, m EZ E 
界 中 ， 动 作 却 越 来 越 
器 人 再 一 次 在 少数 研究 实验 室 出 现 。 


研究 热潮 和 遍布 世界 的 智能 机 器 人 大 
了 目前 领域 机 器 人 的 研究 现状 。 


处 理 、 知 能、 动作 到 


让 人 类 着 迷 了 几 千 年 。 在 20 世纪 之 前 制造 的 机 器 人 没有 
系 起 来 ， 只 是 通过 人 力 或 者 是 重复 性 的 机 器 来 驱动 。 
信 ， 电 子 登 上 舞台 之 后 ， 才 制造 出 了 第 一 
的 机 器 人 。 在 1950 年 前 ， 

。20 世纪 60 年 代 ， 工 业 机 器 人 进入 了 人 们 的 视 
门 对 环境 越 来 越 不 敏感 ， 而 在 它们 自己 的 工程 化 
快 。20 世纪 70 年 代 中 期 ， 
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直 
台 真 正 感 知 世 
看 到 流行 杂志 中 出 现 


我 们 开始 


在 法 国 、 日 本 和 美国 ， 机 
现在 我 们 已 经 迎 来 了 一 个 世界 性 的 
MERRIER R AEM R 
从 机 器 人 的 机 械 装 置 、 感 应 和 知觉 


许多 应 用 领域 ， 本 书 都 有 涉及 。 


Rodney Brooks 
美国 麻 省 理工 学 院 教授 


我 非常 幸运 地 生活 在 过 去 30 年 来 机 器 人 的 研究 革命 之 中 。 在 澳大利亚 ， 当 我 还 是 一 个 少年 的 时 候 ， 在 


1949 年 和 1950 年 我 受到 Walter 在 《 科 


年 抵达 硅谷 时 ， 恰 好 是 计算 机 个 人 


机 器 人 “The Cart” 在 6 个 小 时 之 内 和 


能 实验 室 ，Sebastian Thrun 和 他 的 团 
之 中 就 提高 了 4 个 数量 级 ， 


我 们 已 经 远离 了 那样 的 机 器 人 ， 
期 ， 机 器 人 已 经 察 过 了 肉体 和 机 器 


献 者 。 
本 手册 介绍 的 研究 结果 提 


队 
比 每 两 年 就 翻 一 番 的 速度 还 
在 数量 上 也 增加 了 。 我 在 1977 年 刚 到 斯 坦 福 人 工 管 


成 也 有 类 似 的 壮大 发 展 ， 尽 管 提 供 一 
境 ， 人 距离 一 起 工人 


学 美国 人 》 中 所 描述 


在 1979 年 我 已 经 可 以 协助 斯 坦 福 人 工 智 能 实验 室 (SAIL) 的 Hans Moravec 工作 了 ， 当 时 他 正在 耐心 地 使 


已 


的 乌龟 的 启发 ， 制 作 了 一 个 机 器 人 。 当 我 在 1977 
比 革命 真正 开始 的 时 候 ， 但 是 我 转向 了 更 为 模糊 的 机 器 人 世界 的 研究 当中 。 


rnm 


E 


行驶 20 米 。 就 在 26 年 之 后 的 2005 年 ， 在 同样 的 实验 室 一 一 斯 坦 福 人 工 管 


BOE 


FE — Rs 


个 简洁 


音韵 律 当中 


供 了 推动 机 器 人 伟大 进步 的 关键 想法 。 参 与 和 部 分 参与 工作 的 编辑 们 和 所 有 


者 把 这 些 知 识 汇 集 起 来 ， 完 成 了 一 项 一 流 的 工作 。 这 项 工作 将 会 为 机 器 人 的 进一步 研发 提 


并 祝贺 所 有 在 这 项 关键 工作 中 
对 一 些 未 来 机 器 人 的 研究 


我 相信 能 
力 时 的 年 龄 


描述 为 ; 


e 一 个 两 岁 小 孩子 的 物体 认 知 能 


e —^- 


四 岁 小 孩子 的 语言 BH 能 力 。 


付出 劳动 的 人 们 。 

将 通过 采用 和 改善 技术 得 以 增加 。 

这 些 研 究 的 基础 会 与 一 些 观念 以 及 本 书 所 述 
当 你 在 研究 本 书 ， 寻 找 一 些 领域 来 通 

力 和 灵感 会 使 机 器 人 更 加 有 用 ， 更 加 高 产 ， 更 容易 被 接受 。 


的 现 有 技术 发 展 水 平 相反 。 


过 你 自己 的 才华 和 努力 对 机 器 人 研究 


未 来 机 器 人 研究 的 其 他 方面 将 会 更 具 革 命 


做 出 贡献 的 


的 


供 基础 。 谢 谢 你 


时 候 ， 我 想 提醒 


已 经 可 以 使 机 器 人 在 6 个 小 时 之 内 自动 行驶 200000 米 了 ， 在 仅仅 26 年 
但 是 ， 机 器 人 不 仅仅 是 在 速度 上 提升 了 ， 
9 能 实验 室 的 时 候 ， 世 界 上 只 有 3 合 移动 机 器 人 在 运行 。 
近 ， 我 投资 建立 的 一 个 公司 制造 了 第 3000000 人 台 移 动机 器 人 ， 并 且 我 们 制造 的 步伐 还 在 加 快 。 机 器 人 的 其 1 
的 数字 化 的 描述 更 难 一 些 。 以 前 ， 机 器 人 太 不 清楚 它们 周围 的 
FE 非常 不 安全 ， 而 且 机 器 人 也 根本 意识 不 到 人 们 的 存在 。 但 是 近 
还 制造 出 了 可 以 从 人 们 的 面部 表情 和 声 
的 界限 ， 所 以 现在 我 们 正在 看 到 
术 的 机 器 人 到 为 残疾 人 设计 的 康复 机 器 人 。 最 近 


它们 


E 


取 


也 领 


环 


E 
领悟 其 暗示 的 机 器 人 。 近 
一 系列 的 智能 机 器 人 ， 包 括 从 会 修复 牵引 
， 机 器 人 已 经 成 为 了 认 知 科学 和 智能 科学 研究 中 受 尊敬 的 贡 


作 


我 把 这 些 能 力 按照 一 个 小 孩子 拥有 同等 能 
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e 一 个 六 岁 小 孩子 的 灵巧 能 

e 一 个 八 岁 小 孩子 的 社会 理解 能 

达到 上 述 每 一 个 程度 都 是 非常 困难 的 目标 。 但 是 即使 是 朝向 以 上 任何 一 个 目标 的 微小 进步 也 将 会 立即 应 用 
在 外 面世 界 的 机 器 人 上 。 当 你 进一步 对 机 器 人 学 有 所 贡献 之 时 ， 好 好 阅读 本 书 并 祝 你 好 运 。 


Rodney Brooks 
美国 麻 省 理工 学 院 ， 剑 桥 
2007 年 10 月 


ET 一 
Hy ri 


机 器 人 在 达到 人 类 前 沿 的 同时 ， 积 极 应 对 着 新 兴 领 域 中 出 现 的 各 种 挑战 。 新 一 代 机 器 人 和 人 类 互动 ， 和 人 
类 一 起 探索 、 工 作 ， 它 们 将 会 越 来 越 多 地 接触 人 类 及 其 生活 。 实 用 机 器 人 的 前 景 令 人 信服 是 半 个 世纪 的 机 器 人 
科学 发 展 的 结果 ， 这 种 发 展 将 机 器 人 作为 现代 科学 学 科 建 立 起 来 。 

机 器 人 领域 的 快速 发 展 推动 了 这 本 《机 器 人 手册 》 的 诞生 。 随 着 期 刊 、 会 议论 文集 和 专著 的 增加 ， 参 与 
机 器 人 科学 技术 研究 的 人 ， 特 别 是 刚 进 入 该 领域 的 人 ， 很 难 跟 得 上 它 大 范围 发 展 的 脚步 。 由 于 机 器 人 技术 是 多 
学 科 交 叉 的 技术 ， 这 个 任务 就 显得 尤为 艰难 。 

这 本 手册 依据 20 世纪 80, 90 年 代 机 器 人 学 的 发 展 成 果 ， 这 些 成 果 对 机 器 人 领域 的 研究 很 有 参考 价值 : 
《机 器 人 策略 : 规划 和 控制 》( 了 Brady，Hollerbach，Johnson，Lozano- Perez， 和 Mason, MIT 出 版 社 ，1982 ) , 《机 
器 人 科学 》 (Brady, MIT 出 版 社 ，1989) ， 机 器 人 评论 1 和 2 (Khatib, Craig, f" Lozano-Pérez, MIT 出 版 社 ， 
1989 和 1992)。 随 着 机 器 人 领域 更 大 的 扩展 以 及 向 其 他 学 科 的 日 渐 延 伸 ， 人 们 对 一 部 包含 机 器 人 基本 知识 和 先 
进发 展 的 综合 性 参考 手册 的 需求 越 来 越 强烈 。 

这 本 手册 是 世界 各 国 多 位 积极 参与 机 器 人 研究 的 作者 的 努力 成 果 。 将 各 位 作者 组 织 成 一 个 目标 明确 、 能 力 
卓越 的 团队 ， 卓 有 见地 地 介绍 覆盖 机 器 人 各 个 领域 的 知识 ， 这 是 一 项 艰巨 的 任务 。 

这 个 工程 开始 于 2005 年 5 月 ， 我们 和 施 普 林 格 欧洲 工程 主管 Dieter Merkle 及 STAR 的 资深 编辑 Thomas 
Ditzinger 一 起 参加 会 议 期 间 。 一 年 以 前 ， 我 们 和 Frans Groen —38 EZ £1 T “斯 普 林 格 先进 机 器 人 技术 ”系列 小 
册子 ， 这 个 小 册子 迅速 成 为 及 时 传播 机 器 人 技术 研究 信息 的 重要 媒介 。 

正 是 在 这 种 背景 下 ， 我 们 开始 了 这 个 具有 挑战 性 的 任务 ， 满 腔 热情 地 开始 规划 开发 技术 结构 和 构建 作者 团 
队 。 我 们 构思 了 一 部 由 3 层 架 构 、 共 7 篇 内 容 的 手册 ， 在 机 器 人 领域 已 经 建立 了 的 学 术 中 心 、 目 前 正在 进行 的 
研发 ， 以 及 新 兴 应 用 中 获取 该 领域 多 层面 的 信息 。 

第 一 层 即 第 1 篇 是 机 器 人 学 基础 。 综 合 的 方法 和 技术 包含 在 第 二 层 的 四 篇 中 ， 涵 盖 了 机 器 人 的 结构 、 传 感 
和 感知 ， 操 作 和 接口 ， 移 动 和 分 布 式 机 器 人 。 第 三 层 ， 包 括 机 器 人 技术 在 两 个 领域 先进 的 应 用 ， 分 别 是 : 服务 
机 器 人 和 以 人 为 中 心 的 仿 人 机 器 人 。 

为 了 展开 上 述 各 部 分 ， 我 们 设想 建立 一 个 编辑 团队 ， 来 整理 作者 的 稿件 ， 以 组 成 各 个 章节 。 一 年 后 我 们 的 
七 人 编辑 团队 形成 了 : David Orin, Frank Park, Henrik Christensen, Makoto Kaneko, Raja Chatila, Alex Zelinsky 
和 Daniela Rus. 。 有 这 样 一 批 杰出 的 学 者 致力 于 这 个 手册 的 编辑 工作 ， 该 手册 在 学 术 领 域 一 定 是 高 质量 、 大 跨 
度 的 。 

到 2005 年 初 ， 我 们 的 作者 超过 了 1150 位 。 为 了 方便 内 部 以 及 各 个 章节 的 交叉 参照 ， 把 握手 册 的 编写 进 
度 ， 我 们 制作 了 内 部 网 站 。 第 二 年 ， 就 认真 协调 了 手册 的 内 容 。 尤 其 是 在 2005 年 和 2006 年 春季 的 两 个 全 日 制 
举行 的 讲习 班 ， 大 部 分 作者 都 出 席 了 。 

本 手册 的 每 一 章 都 由 至 少 3 个 独立 的 审 稿 人 员 进 行 审 稿 ， 通 常 都 会 包括 那 一 章 的 编辑 和 两 位 相关 章节 的 作 
者 ， 有 了 时候 也 会 由 一 些 该 领域 的 其 他 专家 进行 审阅 。 必 须 审读 两 亡 ， 有 了 时候 甚至 是 三 遍 。 在 这 个 过 程 中 ， 只 要 
认为 有 必要 ， 就 会 加 入 几 位 新 的 作者 。 本 书 大 部 分 章节 在 2007 年 夏季 之 前 已 定稿 ， 在 2008 年 早春 之 前 书稿 已 
全 部 完成 一 一 那 时 候 ， 我 们 收 到 了 10000 多 份 电子 邮件 ， 汇 集 了 来 自 165 位 作者 的 7 篇 总 共 64 章 1650 多 页 的 
内 容 ， 有 950 幅 插图 ，5500 篇 参考 文献 。 

我 们 对 作者 们 的 脑力 劳动 深 表 谢 意 ， 也 同样 感谢 审 稿 人 员 和 各 部 分 编辑 的 尽职 尽责 。 感 谢 “ 施 普 林 格 科 
学 和 工程 手册 ”的 高 级 经 理 Werner Skolaut， 他 全 力 支 持 稿 件 的 编辑 加 工 工作 ， 将 手册 的 编辑 和 审 稿 、 出 版 相 
结合 ， 很 快 成 为 了 我 们 团队 很 投入 的 一 名 队员 。 感 谢 Le-TeX 的 工作 人 员 的 高 度 专业 化 的 工作 ， 他 们 重新 排版 
了 所 有 的 文字 ， 重 绘 和 完善 了 很 多 图 稿 ， 同 时 在 校对 材料 时 及 时 地 和 作者 互动 。 
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在 出 版 手册 这 个 想法 产生 六 年 之 后 ， 这 本 手册 终于 面世 了 。 除 了 它 对 研究 人 员 的 指导 意义 以 外 ， 我 们 也 
希望 这 本 手册 能 够 吸引 一 些 新 的 研究 者 进入 机 器 人 领域 ， 激 励 这 个 充满 魅力 的 领域 几 十 年 的 莲 勃 发 展 。 每 一 
次 努力 的 完成 ， 总 会 带 来 新 的 令 人 振奋 的 挑战 。 在 这 种 时 候 我 们 都 会 提醒 我 们 的 研究 员 一 一 保持 前 进 的 
梯度 。 


Bruno Siciliano 

Oussama Khatib 

意大利 那不勒斯 大 学 、 美 国 斯 坦 福 大 学 
2008 年 4 月 


编辑 简介 


Bruno Siciliano (布鲁诺 . 西西 利 亚 诺 )，1987 年 毕业 于 意大利 那不勒斯 大 
学 ， 获 电子 工程 学 博士 学 位 。 控 制 和 机 器 人 技术 的 专家 ， 那 不 勒 斯 大 学 计算 机 和 
系统 工程 PRISMA 实验 室 主任 。 目 前 研究 力 控制 、 视 觉 伺 服 、 工 业 机 器 人 / 手 操 
作 、 轻 型 柔性 手臂 、 人 -机 器 人 交互 以 及 服务 机 器 人 。 合 著 出 版 图 书 6 本 ， 编 辑 
合 订 本 5 本 ， 发 表 期 刊 论文 65 篇 ， 会 议论 文 及 专著 章节 165 篇 ， 被 世界 各 机 构 邀 
请 作 了 85 次 讲座 和 研讨 会 。 施 普 林 格 高 级 机 器 人 报告 (STAR). 系列 、 施 普 林 格 
机 器 人 手册 的 合作 编辑 ， 众 多 有 声望 期 刊 的 编 委 会 成 员 ， 许 多 国际 会 议 的 主席 或 
联合 主席 。IEEE 会 士 和 ASME 会 士 。IEEE 机 器 人 与 自动 化 协会 (RAS) 主席 ， 
曾 担任 该 协会 技术 活动 副 主 席 和 出 版 活动 副 主 席 ， 卓 越 讲 师 ， 行 政委 员 会 和 其 他 
几 个 协会 委员 会 成 员 。 


Oussama Khatib ( 欧 沙 玛 . S42 P), 1980 年 毕业 于 法 国 图 卢 效 的 高 等 航空 航 
天 研究 所 (Sup Aer), ， 获 电子 工程 博士 学 位 。 斯 坦 福 大 学 计算 机 科学 教授 。 当 
前 主要 研究 以 人 为 本 的 机 器 人 技术 ， 以 及 关于 人 体 和 运动 合成 、 仿 人 机 器 人 、 触 觉 
远程 操控 器 、 医 疗 机 器 人 、 与 人 友好 机 器 人 的 设计 。 他 在 这 些 领域 的 研究 依赖 于 
他 从 事 25 年 的 研究 成 果 ， 发 表 论 文 200 余 篇 。 他 在 世界 各 机 构 作 了 50 多 次 主题 
报告 ， 参与 了 儿 百 次 座谈 会 和 研讨 会 。 施 普 林 格 高 级 机 器 人 报告 (STAR) 系列 、 
施 普 林 格 机 器 人 手册 的 合作 编辑 ， 担 任 知 名 机 构 和 期 刊 的 顾问 编辑 委员 会 成 员 ， 
很 多 国际 会 议 的 主席 或 联合 主席 。IEEE 会 士 ，IEEE 机 器 人 与 自动 化 协会 (RAS) 
的 卓越 讲师 ， 管 理 委员 会 成 员 。 机 器 人 研究 国际 基金 委员 会 (IFRR) 主席 ， 
获 日 本 机 器 人 协会 (JARA) 研究 与 发 展 奖 。 


各 篇 编者 简介 


David E. Orin 

The Ohio State University 
Department of Electrical Engineering 
Columbus, OH, USA 

Orin. 1 @ osu. edu 


David E. Orin, 1976 年 毕业 于 美国 俄亥俄 州立 大 学 ， 获 电子 工程 专业 博士 学 位 。1976 一 1980 年 在 美国 凯 斯 
西 保留 地 大 学 教书 。1981 年 至 今 在 俄亥俄 州立 大 学 担任 电子 与 计算 机 工程 教授 。 目 前 致力 于 两 足 动物 的 动态 
移动 。 他 对 机 器 人 动力 学 和 双 腿 运动 做 出 过 许多 贡献 ， 已 发 表 论文 125 余 篇 。 他 从 所 在 大 学 获得 了 许多 教育 
X, IEEE 会 士 ， 担 任 多 个 国际 会 议 的 程序 委员 会 委员 。 他 因为 IEEE 机 器 人 与 自动 化 协会 (RAS) 服务 而 获得 
了 杰出 服务 奖 ， 服 务 包括 财 金 副 主席 ， 秘 书 ， 行 政委 员 会 成 员 和 会 士 评 价 委员 会 联合 主席 。 
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Frank C. Park 


Seoul National University 


Mechanical and Aerospace Engineering 


个 Seoul ，Korea 
AS 
fep@ snu. ac. kr 


Frank C. Park, 1991 年 毕业 于 美国 哈佛 大 学 ， 获 应 用 数学 博士 学 位 。1991 一 1995 年 担任 欧文 加 利 福 尼 亚 大 
学 机 械 与 航空 航天 工程 系 助理 教授 。1995 年 至 今 在 国立 首尔 大 学 机 械 与 航空 航天 工程 学 院 担任 全 职 教授 。 他 
在 机 器 人 技术 方向 的 主要 研究 兴趣 包括 机 器 人 力学 、 规 划 、 控 制 、 机 器 人 设计 与 结构 和 工业 机 器 人 。 其 他 研究 
方向 包括 非 线性 系统 理论 、 差 异 几 何 及 其 应 用 ， 还 有 相关 领域 的 应 用 数学 。IEEE 机 器 人 与 自动 化 协会 (RAS) 
fb, (IEEE 机 器 人 及 自动 化 学 报 》 资 深 编辑 。 
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Georgia Institute of Technology 
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Atlanta, GA, USA 
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Henrik I. Christensen， 美 国 亚特兰大 左 治 亚 理工 学 院 机 器 人 及 机 器 人 控制 器 的 KUKA 主席 。 分 别 于 1987 年 
和 1990 年 获 奥 尔 堡 大 学 硕士 学 位 和 博士 学 位 。 曾 在 丹麦 、 瑞 典 和 美国 任职 。 发 表 视觉 、 机 器 人 、 人 工 智能 方 
面 的 论文 250 多 篇 。 其 研究 结果 已 经 由 一 些 主要 公司 和 4 个子 公 司 进行 了 商业 化 。 任 欧洲 机 器 人 研究 网 络 
(EURON) 的 协调 者 。 他 作为 一 个 资深 组 织 者 参加 了 50 多 个 不 同 的 会 议和 研讨 会 。 机 器 人 研究 国际 基金 委员 
会 的 成 员 ，STAR 系列 编 委 会 成 员 ， 是 这 个 领域 很 多 领先 期 刊 的 编 委 会 成 员 。IEEE 机 器 人 与 自动 化 协会 
(RAS) 卓越 讲师 。 


各 篇 编者 简介 Xil 
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Makoto Kaneko 

Osaka University 

Department of Mechanical Engineering 
Graduate School of Engineering 

Suita, Japan 


mk@ mech. eng. osaka- u. ac. jp 


Makoto Kaneko, + 1978 年 和 1981 年 在 日 本 东京 大 学 分 别 获 机 械 工程 专业 硕士 和 博士 学 位 。1981 一 1990 
年 担任 东京 大 学 机 械 工程 实验 室 研究 员 ，1990 一 1993 年 担任 九州 工业 大 学 副教授 ，1993 一 2006 年 担任 广岛 
大 学 教授 ， 在 2006 年 他 成 为 了 大 阪 大 学 的 教授 。 其 研究 包括 基于 触觉 的 主动 传 感 、 抓 取 策略 、 极 限 人 类 技 
术 及 其 在 医疗 诊断 的 应 用 ， 曾 获得 十 七 个 奖项 。STAR 系列 编 委 会 成 员 ， 多 个 国际 会 议 的 主席 或 联合 主席 。 
IEEE 会 士 。 担 任 IEEE 机 器 人 与 自动 化 协会 成 员 活 动 的 副 主 席 以 及 《IEEE 机 器 人 与 自动 化 学 报 》 的 技术 
编辑 。 
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LAAS-CNRS 


Toulouse ，France 


raja. charila@ laas. fr 


Raja chatila, F 1981 年 获 法 国 图 卢 兹 大 学 博士 学 位 。1983 年 起 担任 法 国 图 卢 效 拉 斯 -国家 科学 研究 中 心 
(LAAS-CNRS) 主管 。1997 年 被 日 本 筑波 大 学 聘请 为 教授 。 其 研究 工作 围绕 以 下 几 个 方面 : 现场 、 行 星 、 航 
空 和 服务 机 器 人 ， 认 知 机 器 人 ， 学 习 ， 人 -机 器 人 交互 和 网 络 机 器 人 。 曾 发 表 国 际 论文 130 多 篇 。 机 器 人 研究 
国际 基金 委员 会 成 员 。 他 担任 若干 个 领先 期 刊 的 编 委 会 成 员 ， 包括 STAR 系列 ， 是 多 个 国际 会 议 的 主席 或 联合 
ER, IEEE 机 器 人 与 自动 化 协会 管理 委员 会 成 员 , 《IEEE 机 器 人 及 自动 化 学 报 》 的 副 编辑 ， 卓 越 讲 师 。IEEE， 
ACM 和 AAAI 的 成 员 ， 不 同 国内 和 国际 委员 会 及 评价 委员 会 成 员 。 
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Alexander Zelinsky 

Commonwealth Scientific and Industrial 
Research Organisation ( CSIRO) 

ICT Centre 

Epping, NSW, Australia 


Alex. zelinsky@ csiro. au 


Alexander Zelinsky， 澳 大 利 亚 联邦 科学 与 工业 研究 组 织 (CSIRO) 信息 与 通信 技术 中 心 主管 。 在 加 入 
CSIRO 前 ， 他 在 信息 科学 与 工程 研究 学 院 ， 是 Seeing Machines Pty Limited 的 首席 执行 官 与 创始 人 和 澳 大 利 
亚 国立 大 学 的 教授 。 他 是 专门 从 事 机 器 人 和 计算 机 视觉 的 知名 科学 家 ， 作 为 人 机 交互 的 改革 者 而 广 为 人 
知 ， 他 在 该 领域 发 表 论 文 100 余 篇 。 获 得 了 国内 和 国际 奖项 。 担 任 两 本 领先 期 刊 的 编 委 会 成 员 ， 是 多 个 
国际 会 议 的 程序 编 委 会 成 员 。IEEE 会 士 ， 担 任 IEEE 机 器 人 及 自动 化 协会 管理 委员 会 成 员 和 工业 活动 副 
主席 。 
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Daniela Rus, 1992 年 毕业 于 美 


IN aA Bra, M 2004 年 起 在 美国 


国 康 奈 尔 大 学 ， 获 计算 机 科学 博士 学 位 。1994 一 2003 年 任教 于 德 


国 汉诺威 


麻 省 理工 学 院 工作 ， 目 前 担任 麻 省 理工 学 院 电 子 工 程 和 计算 机 科学 教授 。 


CSAIL 机 器 人 中 心 副 主管 。 她 的 研究 兴趣 集中 在 分 布 式 机 器 人 和 移动 计算 。 她 在 这 个 领域 发 表 论 文 多 篇 。 她 在 
机 器 人 方面 的 工作 目标 是 开发 自 组 织 系统 ， 从 新 型 机 械 设计 、 实 验 平台 一 直 扩展 到 定位 的 开发 与 分 析 算法 。 获 
得 了 诸多 奖项 ， 包 括 麦 克 阿 司 研 究 员 。 多 个 国际 会 议 的 程序 委员 会 成 员 ，IEEE 机 器 人 及 自动 化 协会 教育 联合 
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Department of Aerospace Engineering 


AR 
ARAMIS 


ASCL 
ASD 
ASIC 
ASKA 
ASM 
ASN 
ASTRO 
ASV 
AT 
ATLSS 
ATR 


AuRA 


Mi Wh ie A Be 


American Association for Artificial Intelligence 
articulated- body algorithm 

automated bus rapid transit 

airborne collision avoidance systems 
adaptive cruise control 

active cord mechanism 

Association of Computing Machinery 
advanced driver assistance systems 
activities of daily living 

asymmetric digital subscriber line 
automated guided vehicles 

advanced highway systems 

artificial intelligence 

anterior interparietal area 

artificial intelligence ( AI) system 
artificial intelligence and simulation behavior 
anterior inferotemporal cortex 
actuators for manipulation 

artificial moral agents 

autonomous mental development 
American National Standards Institute 
antipersonnel 

adjustable pattern generator 


augmented reality 


美国 人 工 智能 协会 
关节 体 算法 

自动 快速 公交 
空运 防 撞 系 统 

自 适应 巡航 控制 
主动 蛇 形 机 构 
(美国 ) 计算 机 械 协 会 
先进 驾驶 员 辅 助 系统 
日 常生 活活 动 
非 对 称 数字 用 户 专 线 
Hase Ctra 
先进 的 公路 系统 

人 工 智能 
顶 内 区 前 侧 
人 工 智 能 系统 

人 工 智 能 与 仿真 行为 
Hise pz 


in 


美国 国家 标准 研究 所 
杀伤 性 的 
n SES ESSE oss 
增强 现实 


Space Application of Automation ，Robotics and Machine Intelligence 


adaptive seek control logic 

autism spectrum disorder 

application- specific integrated circuit 
receptionist robot 

advanced servomanipulator 

active sensor network 

autonomous space transport robotic operations 
adaptive suspension vehicle 


antitank 


advanced technology for large structural systems 


自 适应 搜索 控制 逻辑 
自 闭 证 谱系 障碍 
特殊 应 用 集成 电路 
机 器 人 接待 员 
高 级 伺服 机 械 了 
主动 传感器 网 络 

主 空间 运输 机 器 人 操作 
3 适应 悬浮 车 辆 

反 坦克 (的 ) 

大 型 结构 系统 先进 技术 


m 


k H 


Advanced Telecommunications Research Institute International 


autonomous robot architecture 


国际 电信 基础 技术 研究 所 
自主 式 机 器 人 架构 


] 动 化 、 机 器 人 与 机 器 智能 的 航天 应 用 


XXXIV 缩 略语 列表 
AUV autonomous underwater vehicles 9 主 式 水 下 交通 工具 
AV antivehicle P KITH 
B 
BIOROB biomimetic robotics 仿生 机 器 人 
BLDC brushless direct current 无 刷 直流 
BLE broadcast of local eligibility 本 地 广播 资格 
BLEEX Berkeley lower- extremity exoskeleton 伯克利 机 械 下 肢 外 骨骼 
BLUE best linear unbiased estimator 最 优 线 性 无 偏 估计 器 
BN Bayes network 贝 叶 斯 网 络 
BRT bus rapid transit 快速 公交 
C 
C/A coarse- acquisition 粗 捕获 码 
CAM computer- aided manufacturing 计算 机 辅助 制造 
CAD computer- aided design 计算 机 辅助 设计 
CAE computer- aided engineering 计算 机 辅助 工程 
CALM continuous air interface long and medium range 中 远程 空中 通信 
CAN controller area network 控制 器 区 域 网 络 
CARD computer- aided remote driving 计算 机 辅助 远程 驱动 
CASPER continuous activity scheduling, planning, execution and replanning 
持续 的 活动 日 程 安排 , 计划， 执行 和 重 规划 
CAT computer- aided tomography 计算 机 辅助 X 光 断 层 成 像 
CB cluster bombs 集束 炸弹 
CCD charge- coupled devices 电荷 耦合 器 件 
CCI control command interpreter 控制 命令 解释 器 
CCP coverage configuration protocol 履 盖 配置 协议 
CCT conservative congruence transformation 守恒 转换 
CCW counterclockwise 闭 时 针 
CE computer ethics 计算 机 伦理 学 
CEA Commission de Energie Atomique 原子 能 委员 会 
CEBOT cellular robot 蜂窝 机 器 人 
CF climbing fibers 攀登 纤维 
CF contact formation 接触 格式 
CC center of gravity 重心 
CGA clinical gait analysis 临床 步 态 分 析 
CGI common gateway interface 通用 网 关 接 口 
CIE International Commission on Illumination 国际 照明 委员 会 
CIRCA cooperative intelligent real- time control architecture 协同 智能 实时 控制 架构 
CIS computer- integrated surgery 计算 机 集成 外 科 手 术 
CLARAty coupled layered architecture for robot autonomy 机 器 人 自治 耦合 分 层 架 构 
CLEaR closed- loop execution and recovery 闭环 执行 和 恢复 
CLIK closed- loop inverse kinematics 闭环 逆 运 动 学 
CMAC cerebellar model articulation controller 小 脑 模 型 关节 控制 器 
CML concurrent mapping and localization 即时 地 图 构建 与 定位 


缩 略 语 列表 


CNC computer numerical control 计算 机 数值 控制 

CNP contract net protocol 合同 网 协议 

CNT carbon nanotubes 碳 纳 米 管 

COG center of gravity 重心 

CONE Collaborative Observatory for Nature Environments 自然 环境 的 协同 观察 

CONRO configurable robot 可 重 构 机 器 人 

COR center of rotation 旋转 中 心 

CORBA common object request broker architecture 通用 对 象 请 求 代理 体系 结构 

COV characteristic output vector 特征 输出 向 量 

CP closest point 最 近 点 

CP complementarity problem 互补 问题 

CP cerebral palsy FRAT E PRISE. 

CPG central pattern generators 中 枢 神经 模式 发 生 需 

CPSR computer professional for social responsibility 负 有 社会 责任 的 计算 机 专业 

CRBA composite- rigid- body algorithm 复合 刚体 法 

CRLB Cramer- Rao lower bound 克拉 默 - 拉 奥 下 界 

CSIRO ( Australia’s) Commonwealth Scientific and Industrial Research Organization 
澳大利亚 科学 与 工业 研究 院 

CSMA carrier sense multiple access 载波 侦 听 多 路 访问 

CT computed tomography 计算 机 XX 光 断 层 成 像 

CTFM continuous-transmission frequency- modulated 连续 传输 调频 

CTL cut-to- length 定 尺 剪 切 

CU control unit 控制 单元 

CVIS cooperative vehicle infrastructure systems 车 路 协同 系统 

CW clockwise 顺 时 针 

D 

DARPA Defense Advanced Research Projects Agency 国防 部 高 级 研究 计划 局 (美国 

DARS distributed autonomous robotics systems 分 布 式 自主 机 器 人 系统 

DBNs dynamic Bayesian networks 动态 贝 叶 斯 网 络 

DD differentially driven 差 速 驱动 

DDF decentralized data fusion 离散 数据 融合 

DeVAR desktop vocational assistant robot 桌面 职业 辅助 机 器 人 

DFRA distributed field robot architecture 分 布 式 现 场 机 器 人 架构 

DFT discrete Fourier transform 离散 傅 里 叶 变 换 

DGA Delegation Generale pour L'Armement 武器 装备 总 代表 处 (ERES) 

DH Denavit- Hartenberg D-H iX 

DIO digital input- output 数字 输入 输出 

DIRA distributed robot architecture 分 布 式 机 器 人 架构 

DL description logics 描述 逻辑 

DLR Deutsches Zentrum fiir Luft- und Raumfahrt 德国 航天 航空 中 心 

DM2 distributed macro- mini actuation 分 布 式 宏 - 微 驱动 

DoD Department of Defense 国防 部 (美国) 

DOF degree of freedom =| FA RE 


DOG difference of Gaussian 高 斯 差分 


XXXVI 缩 略语 列表 
DOP dilution of precision 精度 衰减 因子 
DPN dip- pen nanolithography 沾 笔 纳米 刻 蚀 
DRIE deep reactive ion etching 深度 反应 离子 刻 蚀 
DSM dynamic state machine 动态 状态 机 
DSO Defense Sciences Office 国防 科学 办 公 室 (美国 ) 
DSRC dedicated short- range communications 专用 短程 通讯 协议 
DVL Doppler velocity log 多 普 勒 计 程 仪 
DWA dynamic window approach 动态 窗口 法 
E 
EBA extrastriate body part area 纹 状 体 部 分 区 域 
EBID electron- beam- induced deposition 电子 束 诱导 沉积 
ECU electronics controller unit 电子 控制 单元 
EDM electrical discharge machining rm T. 
EDM electronic distance measuring 电子 测 距 
EEG electroencephalogram 脑 电 图 
EGNOS Euro Geostationary Navigation Overlay Service 欧洲 地 球 同步 卫星 导航 增强 服务 系统 
EKF extended Kalman filter 扩展 卡尔 曼 滤波 器 
EM expectation maximization 期 望 最 大 化 
EMG electromyography 肌 电 图 
EMS electrical master- slave manipulators 电气 主 从 机 械 臂 
ENSICA Ecole Nationale Superieure des Constructions Aeronautiques 

国立 高 等 航空 制造 工程 师 学 院 

EO elementary operators 初等 算 子 
EOD explosive ordnance disposal 爆炸 物 处 理 
EP exploratory procedures 探索 性 方法 
EPFL Ecole Polytechnique Fédérale de Lausanne 洛桑 联邦 理工 大 学 
EPP extended physiological proprioception 扩展 生理 本 体 
ERA European robotic arm 欧洲 机 器 人 臂 
ES electrical stimulation 电 刺 激 
ESA European Space Agency 欧洲 航天 局 
ESL execution support language 执行 支持 语言 
ETS engineering test satellite 工程 试验 卫星 
EVA extravehicular activity 舱 外 活动 
F 
FARS Fagg- Arbib- Rizzolatti- Sakata TS BAA Eon - chose - 3 HH 
FE finite element 有 限 元 
FESEM field- emission SEM 场 发 射 扫描 电镜 
FIFO first- in first- out 先入 先 出 
fMRI functional magnetic resonance imaging 功能 性 磁 共 振 成 像 
FMS flexible manufacturing systems 柔性 制造 系统 
FNS functional neural stimulation 功能 性 神经 刺激 
FOPL first- order predicate logic 一 阶 谓词 逻辑 
FPCAs field programmable gate array 现场 可 编程 门 阵列 
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HAL 
HAMMER 


HCI 
HD 
HDSL 
HEPA 
HF 
HIC 
HIP 


foot rotating indicator 
finite- state acceptors 
finite- state machine 

force sensing resistor 
finite- state transducer 
feasible solution of wrench 


fiber to the home 


global asymptotic stability 

ground- based augmentation systems 
goal- contact relaxation 

gross domestic product 

generator of modules 

geostationary Earth orbit 


gastrointestinal 


WERE RE 
有 限 状态 接收 器 
有 限 状态 机 

力 敏 电阻 

有 限 状态 传感器 
扳手 可 行 解 
光纤 到 户 


全 局 渐进 稳定 性 
也 基 增 强 系统 
目标 接触 放松 
国内 生产 总 值 
发 生 器 模块 
同步 地 球 轨道 
ELAN 


w 


Geneva International Center for Humanitarian Demining 


generalized Jacobian matrix 


Global Navigation Satellite System Landing System 


Gaussian mixture model 
Gaussian mixture regression 
global navigation systems 

global navigation satellite system 
Gaussian processes 

ground- penetrating radar 

general packet radio service 
global positioning system 
graduate robot attending conference 
geon structural description 
Gadd's severity index 

graphical user interface 
generalized ZMP 


hybrid assisted limb 


日 内 瓦 人 道 主 义 排 雷 国际 中 心 
广义 雅克 比 和 矩阵 

全 球 导航 卫星 系统 着 陆 系 统 
高 斯 混合 模型 
高 斯 混合 回归 

全 球 导航 系统 

全 球 导航 卫星 系统 
高 斯 过 程 
探 地 雷达 (地质 雷达 ) 
通用 分 组 无 线 电 业务 

全 球 定位 系统 

出 席 会 议 的 研究 生机 器 人 
几何 离子 结构 描述 模型 
盖 德 氏 严重 程度 指数 

图 形 用 户 界 面 
广义 零 力 矩 点 


混合 辅助 义 胶 


hierarchical attentive multiple models for execution and recognition 


human computer interaction 
haptic device 


high data rate digital subscriber line 


semi- high efficiency- particulate air- filter 


hard- finger 
head injury criterion 


haptic interaction point 


执行 与 识别 的 分 层 感应 多 种 模型 
人 -计算 机 交互 

力 反馈 天 

高 数据 传输 率 数 字 用 户 线 

亚 高 效率 过 滤器 

EFH 

头 部 伤害 度 评定 基准 

触觉 交互 点 
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HJB Hamilton- Jacobi- Bellman 哈密 顿 一 雅克 比 一 贝尔 曼 
HJI Hamilton- Jacobi- Isaac 哈密 顿 一 雅克 比 一 艾 萨 克 
HMD head- mounted display 头 戴 式 显示 器 
HMM hidden Markov model 隐 马 尔 可 夫 模 型 
HMX high melting point explosives 高 熔点 炸药 
HO human operator 人 工 操作 者 
HRI human- robot interaction 人 -机 器 人 交互 
HRTEM high-resolution transmission electron microscopes 高 分 辩 率 透射 电子 显微镜 
HST Hubble space telescope 哈 勃 望远镜 
HSTAMIDS handheld standoff mine detection system 便携 式 地 雷 探测 需 
HTML hypertext markup language 超 文本 标记 语言 
HTN hierarchical task network 分 层 任务 网 络 
I 
Lo input/output 输入 /输出 
I3CON industrialized, integrated, intelligent construction 工业 化 、 集 成 化 、 智 能 化 建设 
IA instantaneous allocation 瞬时 配置 
IAD intelligent assist device 智能 辅助 装置 
ICA independent component analysis 独立 成 分 分 析 
ICBL International Campaign to Ban Landmines 国际 反 地 雷 组 织 
ICE internet communications engine 因特网 通信 引擎 
ICP iterative closest- point algorithm XE TIR E ex SUE 
ICR instantaneous center of rotation 转动 瞬 心 
ICRA International Conference on Robotics and Automation 机 器 人 与 自动 化 国际 会 议 
ICT information and communication technology 信息 与 通信 技术 
IDL interface definition language 接口 定义 语言 
IE information ethics 信息 伦理 
IED improvised explosive device 临时 爆炸 装置 
IEEE Institute of Electrical and Electronics Engineers 电气 与 电子 工程 师 协 会 
IETF Internet engineering task force 因特网 工程 任务 组 
IFRR International Foundation of Robotics Research 机 器 人 研究 国际 基金 会 
iGPS indoor GPS 室内 全 球 定位 系统 
IHIP intermediate haptic interaction points 中 间 触 觉 交 互 点 
IK inverse kinematics 道 运动 学 
ILP inductive logic programming 归纳 逻辑 编程 
ILS instrument landing system 仪表 着 陆 系 统 
IMTS intelligent multimode transit system 智能 多 模式 交通 系统 
IMU inertial measurement units 惯性 测量 组 件 
IOSS input- output- to- state stability 输入 -输出 - 状态 稳定 性 
IP internet protocol 互联 网 协议 
IPC interprocess communication 进程 间 通 信 
ISO International Organization for Standardization 国际 标准 化 组 织 
ISP internet service provider 物 联网 服务 提供 商 
ISS input- to- state stability 输入 -状态 稳定 性 
IST Information Society Technologies 信息 社会 技术 


缩 略 语 列表 


IST Instituto Superior Técnico 里 斯 本 高 等 技术 大 学 (和 葡萄牙) 
IT intrinsic tactile 内 在 触觉 

IT inferotemporal 3 P BJ 

ITD interaural time difference 双 耳 时 间 差 

IxTeT indexed time table 索引 时 间 表 

J 

JAUS joint architecture for unmanned systems 无 人 系统 联合 构架 

JAXA Japan space exploration agency 日 本 太空 探索 局 

JDL joint directors of the laboratories 实验 室 理 事 联 合 会 


JEMRMS Japanese experiment module remote manipulator system 


日 本 实验 舱 遥 控 系 统 


JHU Johns Hopkins University 约 输 斯. 霍 普 金 斯 大 学 (美国) 
JND just noticeable difference 恰 可 察觉 差 

JPL Jet Propulsion Laboratory 喷气 推进 实验 室 

JSIM Joint- space inertia matrix 关节 空间 惯性 矩阵 

JSP Java Server Pages Java 动态 网 页 技术 

K 

KR Knowledge representation 知识 表达 

工 

LAAS Laboratoire d'Analyse et d'Architecture des Systemes 结构 与 系统 分 析 实 验 室 (法 国 ) 
LADAR laser radar or laser detection and ranging 激光 雷达 或 激光 探测 和 测 距 
LAN local- area network 局 域 网 

LARC Lie algebra rank condition 李 代 数 秩 条 件 

LBL long- baseline system 长 基线 系统 

LCSP linear constraint satisfaction program 线性 约束 满意 方案 

LGN lateral geniculate nucleus 外 侧 膝 状 体 核 

LIDAR light detection and ranging 光 探 测 和 测 距 

LOS line of sight 视线 

LP linear program 线性 规划 

LQG linear quadratic Gaussian 线性 二 次 高 斯 

LSS logical sensor system 逻辑 传感器 系统 

LVDT linear variable differential transformer 线性 可 变 差 动 变压器 

LWR locally weighted regression 局 部 加 权 回 归 

M 

MACA Afghanistan Mine Action Center 阿富汗 排 雷 行动 中 心 
MANET mobile ad hoc network 移动 自 组 网 络 

MAP maximum a posteriori probability 最 大 后 验 概率 

MBARI Monterey Bay Aquarium Research Institute 蒙特 雷 湾 水 族 馆 研究 所 
MBE molecular- beam epitaxy 分 子 束 外 延 

MBS Imobile base system 移动 基站 系统 


MC Monte Carlo 蒙特 卡 罗 


XL 缩 略语 列表 
MCS mission control system 任务 控制 系统 
MDP Markovian decision process 马尔 可 夫 决 策 过 程 
MST microsystem technology 微型 系统 技术 
MEMS microelectromechanical systems 微机 电 系 统 
MER Mars exploration rovers 火星 探测 漫游 者 
MESUR Mars environmental survey 火星 环境 调查 
MF Mossy fibers 苔 状 纤维 
MIA mechanical impedance adjuster 机 械 阻 抗 调节 
MIG metal inert gas 金属 惰性 气体 
MIMO multi- input multi- output 多 输入 多 输出 
MIR mode identification and recovery 模式 识别 与 恢复 
MIS minimally invasive surgery 微 创 手术 
MITI Ministry of International Trade and Industry 国际 贸易 与 工业 部 
ML maximum likelihood 最 大 似 然 
ML machine learning 机 器 学 习 
MLE maximum- likelihood estimation 最 大 似 然 估计 
MLS multilevel surface map 多 层次 的 表面 图 
MNS mirror neuron system 镜像 神经 元 系统 
MOCVD metallo- organic chemical vapor deposition 金属 有 机 物化 学 气相 沉积 
MOMR multiple operator multiple robot 多 操作 者 多 机 器 人 
MOSR multiple operator single robot 多 操作 者 单机 器 人 
MPC model predictive control 模型 预测 控制 
MPFIM multiple paired forward- inverse models 多 成 对 正 反 模型 
MPM manipulator positioning mechanism 机 械 手 的 定位 机 构 
MR multirobot tasks 多 机 器 人 任务 
MR multiple reflection 多 次 反射 
MR magnetorheological 磁 流 变 
MRAC model reference adaptive control 模型 参考 自 适 应 控制 
MRI magnetic resonance imaging 磁 共 振 成 像 
MRL manipulator retention latch 机 械 手 固定 门 锁 
MRSR Mars rover sample return 火星 采样 返回 探测 需 
MRTA multirobot task allocation 多 机 器 人 任务 分 配 
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Blas AL 火星 、 海 洋 、 医 院 、 家 庭 、 、 学 
校 ， 机 器 人 无 处 不 在 。 机 器 人 能 够 救火 ， 能 够 制造 产 
品 ， 能 够 节约 时 间 、 挽 救生 命 …… 现 如 今 ， 从 制造 
业 ， 到 医疗 保健 、 交 通 运输 以 及 对 外 层 空间 和 深海 的 
探索 ， 机 器 人 正在 对 现代 生活 的 许多 方面 产生 着 相当 
大 的 影响 。 未 来 ， 机 器 人 将 会 和 现在 的 个 人 电脑 一 样 
普及 和 私人 化 。 从 一 开始 ， 人 们 就 梦想 着 能 创造 出 既 
有 能 力 又 有 智慧 的 机 器 。 现 在 这 个 梦想 在 我 们 的 世界 
里 已 经 部 分 成 为 现实 。 

从 早期 文明 开始 ， 人 类 最 大 的 雄心 之 一 就 是 要 创 
造 出 他 们 想象 中 的 物品 。 将 人 类 从 粘土 中 塑造 出 来 的 
巨神 普罗 米 修 斯 或 是 赫 淮 斯 托 斯 锻造 的 青铜 妈 役 巨人 
泰勒 斯 (公元 前 3500 年 ) 的 传奇 证 明了 希腊 神话 
的 这 种 追求 。 埃 及 人 的 甲骨 文中 的 神 论 (公元 前 
2500 年 ) 也 许 正 是 现代 思维 机 器 的 先驱 。 巴 比 伦 人 
制造 的 漏水 计时 器 (公元 前 1400) 是 最 早 的 自动 机 
械 装 置 之 一 。 在 以 后 的 几 个 世纪 里 ， 人 类 的 创造 力 造 
就 出 许多 装置 ， 例 如 ， 有 自动 装置 的 英雄 亚历山大 剧 
院 (100 4E), 、 加 扎 里 (1200 Æ) 的 水 力 灌溉 和 类 人 


技 进 步 。 同 往常 一 样 ， 新 的 设计 会 推动 新 的 研究 和 发 
现 。 与 此 同时 ， 这 些 新 的 研究 和 发 现 又 促使 解决 问题 
方案 的 增加 ， 并 由 此 产生 新 的 概念 。 这 样 一 个 有 效 的 
循环 逐渐 交替 演变 就 催生 了 机 器 人 领域 的 知识 与 认 
知 一 一 更 准确 地 应 该 称 为 机 器 人 科学 与 技术 。 

早期 的 机 器 人 出 现在 20 世纪 60 年 代 ， 它 的 产生 
主要 受到 两 方面 技术 的 影响 : 数控 机 器 在 精密 制造 业 
的 应 用 和 对 远程 放射 性 材料 的 遥控 操作 。 这 些 主 从 式 
机 械 臂 设计 出 来 用 于 重复 人 手臂 所 做 的 “点 到 点 ” 
的 机 械 运动 ， 同 时 它们 具有 基本 的 控制 ， 并 对 环境 几 
乎 没有 感知 。 之 后 , 在 20 世纪 中 后 期 ， 集 成 电路 、 
数字 计算 机 和 微型 元 器 件 的 发 展 使 计算 机 控制 机 器 人 
的 设计 和 编程 成 为 可 能 。20 世纪 70 年 代 ， 这 些 机 器 
人 ， 也 称 为 工业 机 器 人 ， 成 为 了 柔性 制造 系统 自动 控 
制 的 必要 组 成 。 它 们 不 只 在 汽车 工业 上 得 到 了 广泛 应 
用 ， 还 被 成 功 应 用 到 其 他 工业 生产 中 ， 例 如 金属 制造 
业 、 化 工业 、 电 子 业 和 食品 工业 中 。 最 近 ， 机 器 人 还 
在 工厂 之 外 找到 了 新 的 用 武之 地 ， 例 如 它们 在 清洁 、 
搜救 、 水 下 、 太 空 以 及 医疗 应 用 等 方面 均 具 有 广泛 的 


机 和 器， 以 及 莱 昂 纳 多 : 达 芬 奇 的 难以 计数 的 极 具 创造 
性 的 设计 (1500 年 )。 在 18 世纪， 自动 控制 技术 继 
续 在 欧洲 和 亚洲 攻 勃 发 展 ， 其 中 就 有 诸如 Jacquer- 
Droz 的 机 器 人 家 庭 ( 画家、 音乐 家 和 作家 ) 和 kara- 
kuri- ningyo 机 械 木 偶 〈 倒 茶 和 射箭 ) 这 样 的 发 明 。 

机 器 人 的 概念 得 以 清晰 地 建立 源 于 许多 极 具 创造 
力 的 历史 产物 。 但 是 ， 真 正 的 机 器 人 还 是 要 等 到 20 
世纪 其 基础 技术 发 展 后 才能 出 现 。1920 年 ， 英 文 单 
词 “ 机 器 人 ” (robot) 脱胎 于 斯 拉夫 语 中 意思 是 奴隶 
的 单词 “robota”， 它 第 一 次 被 捷克 剧 作 家 Karel 
Capek 用 在 其 剧目 “ 罗 萨 姆 的 万 能 机 器 人 ” (Rossums 
Universal Robots) 中 。1940 4E, AS 5j L8 A zz p] fc 
来 的 道德 准则 就 被 认为 是 约束 在 众所周知 的 机 器 人 三 
原则 之 内 ， 这 个 机 器 人 三 原则 是 美 籍 俄 裔 科幻 小 说 家 
JE vu + BAY PE SESE (Isaac Asimov) 在 他 的 小 说 
《Runaround》 中 提 到 的 。 

在 20 世纪 中 期 ， 人 们 进行 了 对 人 类 智能 与 机 器 
关联 的 第 一 次 探索 ， 这 标志 着 在 人 工 智能 领域 一 个 多 
产 时 代 的 来 临 。 在 这 一 时 期 ， 第 一 台 机 器 人 变 为 现 
实 ， 这 得 益 于 在 机 械 控制 、 计 算 机 和 电子 等 领域 的 科 


应 用 。 
20 世纪 80 年 代 ， 机 器 人 学 被 定义 为 研究 感知 与 
行动 之 间 智 能 连接 的 一 门 科学 。 根 据 这 一 定义 ， 机 如 
人 通过 安装 移动 装置 ( 轮子、 履带 率 引 装置 、 腿 、 
RIEK) 来 实现 在 空间 中 的 移动 ,通过 操作 装置 
CER, Amp Tae. BU) 来 对 物体 进行 加 工 ， 其 
中 ， 一 些 合适 的 装置 赋予 了 机 融 人 具有 人 的 灵性 。 通 
过 分 析 由 传感器 得 来 的 机 器 人 的 状态 参数 (位 置 、 
速度 ) 以 及 与 周边 环境 相关 的 参量 ( 力 和 触觉 、 距 
离 和 视野 ) ， 机 器 人 就 具有 了 感觉 ， 而 其 智能 连接 是 
通过 一 个 经 过 了 编程 、 规 划 和 控制 的 控制 架构 来 实现 
的 ， 这 种 结构 依赖 于 机 带 人 的 感觉 和 动作 模式 、 周 而 
环境 ， 以 及 自身 学 习 能 力 和 技能 习 得 过 程 。 

在 20 世纪 90 年 代 ， 人 类 诉 诸 机 器 人 的 各 种 需求 
推动 了 机 器 人 研究 的 发 展 。 这 些 需求 包括 在 危险 的 时 
候 解 决 人 类 的 安全 问题 CEPA A) ， 或 提高 人 类 
的 操作 能 力 并 且 降 低 人 类 疲劳 程度 (人 类 机 能 增 
强 ) ， 或 实现 一 些 人 在 充满 潜力 的 市 场 里 开发 产品 从 
而 改善 生活 质量 的 愿望 CIR SS MLA AL). HE 
景 的 一 个 共同 之 处 就 是 它们 必须 运作 在 一 个 几乎 非 结 
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构 化 的 环境 中 ， 最 终 达 到 增加 能 力 和 获得 更 高 程度 自 
主权 的 要 求 。 

在 新 千年 来 临 之 际 ， 机 器 人 技术 在 范围 和 维度 上 
经 历 了 重大 变革 。 这 种 扩张 使 机 器 人 领域 变 得 成 熟 ， 
也 使 其 相关 技术 获得 了 进步 。 机 器 人 技术 已 经 从 具有 
主导 优势 的 工业 热点 开始 迅速 扩展 到 成 为 人 类 世界 的 
挑战 (以 人 为 本 和 类 生命 机 器 人 )。 人 们 期 望 新 一 代 
的 机 器 人 可 以 与 人 安全 地 、 可 靠 地 在 家 庭 、 工 作 场 所 
共处 ， 在 社区 提供 服务 ， 在 娱乐 业 、 教 育 行业 、 医 疗 
保健 行业 、 制 造 业 等 方面 提供 支持 和 援助 。 

除去 实体 机 器 人 的 冲击 外 ， 智 能 机 器 人 的 发 展 揭 
示 了 在 不 同 研究 领域 和 学 科 内 可 以 开发 出 更 为 广泛 的 
应 用 ， 例 如 : 运动 生物 力学 、 触 党 学 、 神 经学、 模拟 
仿真 学 、 动 画 制 作 、 外 科 手 术 和 传 感 网 络 学 科 等 。 作 
为 回报 ， 新 兴 领 域 的 挑战 证 明了 机 器 人 领域 具有 如 此 
多 样 化 的 增产 措施 和 启示 。 最 引 人 注 目的 进展 往往 就 
诞生 于 学 科 的 交叉 处 。 

现在 ,伴随 着 越 来 越 多 的 机 器 人 核心 连接 的 研 
究 ， 以 机 器 人 用 户 和 研发 者 为 主 的 群体 正在 形成 。 机 


器 人 社会 的 战略 目标 就 是 与 这 些 群 体 达成 拓展 与 科研 
合作 。 而 为 了 达到 这 个 目标 ， 在 未 来 所 要 进行 的 发 展 
与 可 以 预期 的 成 果 将 很 大 程度 上 依赖 于 科研 团体 的 
能 力 。 

在 过 去 几 十 年 中 ， 研 究 结果 的 推广 、 文 献 期 刊 中 
记录 的 发 现 ， 以 及 学 术 会 议 上 的 讨论 对 机 器 人 的 发 展 
起 了 很 重要 的 作用 。 有 关机 器 人 的 科技 活动 已 经 引领 
了 专业 群体 的 成 立 ， 并 且 使 研究 网 络 开始 转向 这 个 领 
域 。 世 界 各 地 研究 机 构 在 机 器 人 学 方面 的 研究 生计 划 
的 介绍 ， 清 晰 地 展示 了 在 机 器 人 学 这 一 科学 领域 中 科 
人 研 已 经 能 够 达到 的 完善 程度 。 

机 器 人 学 的 密集 研究 情况 已 经 记录 在 了 有 具有 独特 
价值 的 参考 文献 中 ， 这 些 文献 旨 在 搜集 国际 机 器 人 科 
学 共同 体 的 意义 非凡 的 成 果 。 

《机 器 人 手册 》 一 书 从 学 科 基 础 说 起 ， 从 研究 领 
域 ， 直 至 最 新 出 现 的 机 器 人 应 用 ， 展 现 了 机 器 人 学 领 
域 的 一 幅 全 景 图 。 本 书 在 逻辑 上 材料 的 组 织 可 以 分 为 
三 个 层次 ， 它 们 分 别 反映 了 机 器 人 领域 的 历史 发 展 ， 
如 图 1 所 示 。 


图 1 本 手册 的 结构 品 


第 一 层 (第 1 篇 , 包含 9 章 ): 机 器 人 学 基础 ， 
包括 机 器 人 的 力学 、 感 觉 、 设 计 和 控制 。 第 二 层 包 括 : 
统一 的 方法 论 和 机 器 人 构造 技术 (第 2 篇 ,包含 9 
章 ) ， 传 感 与 感知 (第 3 篇 ， 包 含 7 章 ) ， 操 作 与 接口 
(第 4 篇 ,包含 8 章 )， 移动 式 和 分 布 式 机 器 人 技术 


(第 5 fi, 包含 8 章 ) 。 第 三 层 则 致力 于 更 先进 的 应 用 ， 
比如 野外 和 服务 机 器 人 (第 6 篇， 包含 14 XE) 以 及 以 
人 为 中 心 和 类 生命 机 器 人 (第 7 篇 ,， 包含 9 E). 

第 1 篇 介绍 了 在 模型 、 设 计 和 控制 机 器 人 系统 中 
用 到 的 基本 原则 和 方法 。 包 括 运动 学 、 动 力学 、 力 学 


O 图 !1 为 原 书 结构 ， 翻 译 成 中 文 后 ， 经 重新 编排 ， 本 手册 共 分 三 卷 出 版 ， 分 别 为 《机 器 人 手册 第 1 卷 机 器 人 基础 》 
《机 器 人 手册 第 2 卷 机 器 人 技术 》《 机 器 人 手册 第 3 卷 机 器 人 应 用 》。 
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设计 和 了 驱动、 感觉 和 评价 、 运 动 规划 、 运 动 控制 、 力 
控制 、 机 器 人 体系 结构 与 程序 设计 、 用 于 任务 规划 和 
学 习 的 机 器 人 智能 推理 方法 。 本 篇 每 一 章 分 别 曾 述 了 
上 述 的 某 个 主题 。 在 后 续 部 分 中 ， 这 些 主题 将 被 拓展 
和 应 用 到 特殊 的 机 器 人 结构 和 系统 中 。 

第 2 篇 涉及 机 器 人 在 实际 物理 实现 过 程 中 的 设 
计 、 模 型 、 运 动 计划 和 控制 等 问题 。 包 括 一 些 更 加 明 
显 的 机 絮 人 结构 ， 如 辟 、 腿 、 手 ， 轮 式 移 动机 器 人 和 
平台 ， 以 及 一 些 在 毫米 、 纳 米 量 级 的 机 器 人 结构 。 其 
中 一 些 章节 阐述 了 评价 指标 和 模型 辨识 ， 并 成 功 分 析 
了 串联 元 余 度 机 构 、 并 联机 构 、 柔 性 机 器 人 、 机 器 
手 、 机 器 腿 ， 轮 式 机 器 人 以 及 微米 和 纳米 扩 度 机 
ait A 


第 3 篇 涵盖 了 机 器 人 的 不 同感 觉 形态 和 跨 时 空 传 
感 数 据 整 合 。 这 将 用 于 生成 机 器 人 模型 及 外 部 环境 。 
机 器 人 学 是 感知 和 行动 的 智能 耦合 。 第 3 篇 内 容 是 对 
第 2 篇 的 补充 ， 着 重 于 继续 建立 一 个 系统 。 本 篇 包括 
接触 感知 、 本 体感 知 和 外 体感 知 ， 同 时 展示 了 主要 的 
传 感 融 类 型 ， 如 触觉 、 视 觉 里 程 计 、 全 球 定位 系统 、 
测 距 和 视觉 。 还 包含 了 基本 的 传感器 模型 和 多 传感器 


移动 机 器 人 背景 下 补充 了 第 1 篇 的 基础 原理 ， 给 出 了 
感知 的 角色 地 位 ， 在 传 感 方面 与 第 3 篇 紧密 联系 。 另 
外 ， 还 讨论 了 多 机 器 人 交互 和 系统 、 模 块 化 、 可 重 构 
机 器 人 ， 也 介绍 了 网 络 机 器 人 。 
第 6 篇 介绍 野外 机 器 人 和 可 在 所 有 环境 中 工作 的 
用 型 服务 机 器 人 。 包 括 工 业 机 器 人 ， 各 种 各 样 的 在 
海 、 陆 、 空 、 航 天 领域 应 用 的 机 器 人 ， 直 至 教学 机 央 
人 。 本 篇 以 第 1 篇 ~ 第 5 篇 的 内 容 为 基础 ， 描 述 了 如 
何 令 机 器 人 工作 。 
第 7 篇 介绍 了 如 何 创建 在 以 人 为 中 心 的 环境 中 工 
作 的 机 器 人 ， 包括 仿 人 或 称 为 拟人 ) 或 者 仿 其 他 
生物 外 观 的 机 器 人 的 设计 、 传 感 、 传 动 、 驱 动 与 控制 
结构 ， 演 示 编 程 和 安全 性 编程 的 用 户 界 面 内 容 ， 机 内 
人 的 社会 伦理 性 启示 。 

本 手册 不 仪 为 机 器 人 专家 而 写 ， 也 为 将 机 絮 人 作 
为 扩展 领域 的 初学 者 工程师、 医师 、 计 算 机 科学 
家 和 设计 师 ) 提供 了 宝贵 的 资源 。 尤 其 要 强调 的 是 ， 
第 1 篇 的 指导 价值 对 于 研究 生 和 博士 后 很 重要 ， 第 2 
篇 ~ 第 5 篇 对 于 机 器 人 领域 所 覆盖 的 研究 有 着 很 重要 
的 科研 价值 ， 第 6 篇 和 第 7 篇 对 于 对 新 应 用 感 兴趣 的 
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信息 融合 。 其 中 关于 感觉 融合 的 章节 介绍 了 路 时 空 感 
觉 信息 集成 所 需 的 数学 工具 。 
第 4 篇 介绍 了 机 器 人 与 物体 之 间 ， 机 器 人 与 人 之 
间 ， 机 器 人 之 间 的 交互 。 操 作 能 通过 辟 或 手指 的 直接 
接触 或 仅仅 是 推动 来 处 理 一 个 物体 。 接 口 能 使 人 机 交 
互 变 得 直接 或 间接 。 为 了 提高 机 器 人 操作 的 灵巧 度 ， 
本 篇 的 前 半 部 分 介绍 了 诸如 操作 任务 的 动作 、 接 触 模 
拟 和 操作 、 抓 取 、 协 同 操作 等 问题 。 为 实现 更 熟练 的 
操作 或 更 强大 的 人 /机 系统 ， 后 半 部 分 讨论 了 触觉 理 
论 、 遥 操作 机 器 人 、 网 络 愧 控 机 器 人 和 让 人 类 机 能 增 
强 的 外 骨骼 系统 。 

第 5 篇 涵盖 了 各 种 问题 ， 介 绍 了 轮 式 机 器 人 运动 
规划 和 控制 ， 同 时 考虑 了 运动 约束 条 件 、 认 知 和 世界 
模型 、 同 步 定 位 与 建 图 、 控 制 架构 方面 的 集成 等 的 影 
响 。 移 动机 器 人 确实 是 复杂 集成 系统 的 典范 。 本 篇 在 
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- 程 师 和 科学 家 有 着 很 大 的 附加 价值 。 

本 书 各 章 的 内 容 均 经 过 仔细 其 酌 ， 待 验证 的 方法 
和 尚未 完全 成 立 的 方法 均 未 列 人 。 本 手册 从 客观 的 角 
度 出 发 ， 包 含 多 种 方法 ， 具 有 高 的 收藏 价值 。 每 章 都 
有 一 个 简短 的 摘要 ， 并 且 在 概述 部 分 介绍 了 相关 领域 
的 技术 发 展 水 平 。 主 体 部 分 是 以 一 种 教学 方式 来 阐述 
的 。 尽 可 能 避免 元 长 的 数学 推导 ， 方 程 、 表 格 和 算法 
均 以 便于 使 用 的 形式 给 出 。 最 后 一 节 给 出 了 结论 和 题 
目 ， 以 供 进一步 阅读 。 

从 机 器 人 的 基础 开始 到 最 后 讲述 机 器 人 的 社会 意 
义 和 伦 理 启示 ， 本 书 的 64 章 全 面 收集 了 机 器 人 领域 
在 50 年 之 中 的 进展 。 这 是 对 机 器 人 领域 取得 成 就 的 
一 种 证 明 ， 也 是 将 来 新 的 前 沿 机 器 人 取得 更 大 进展 的 
保证 。 
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机 器 人 手册 的 第 3 篇 是 介绍 传 感 与 估计 内 容 的 章 
节 。 众 所 周知 ， 当 今世 界 正在 快速 变化 ， 加 之 机 絮 人 
的 模型 并 非 完美 ， 因 此 传 感 的 引进 补偿 了 模型 近似 误 
差 ， 同 时 估计 环境 的 参数 配置 以 便于 机 器 人 进行 规划 
编程 和 执行 任务 。 

传 感 是 将 外 部 物理 量 转变 为 一 个 内 部 的 计算 机 变 
量 ， 这 些 物 理 量 包 括 接触 、 力 、 距 离 、 光 强 等 。 感 知 
是 从 传 感 数 据 中 的 提取 关键 特性 和 随时 间 变 化 的 传 感 
信息 的 集成 。 由 于 涉及 特征 提取 ， 因 此 感知 可 以 看 做 
是 一 种 典型 的 数据 压缩 任务 ， 提 取出 的 特征 要 能 够 实 
现 真 实 世 界 中 机 器 人 执行 任务 所 需要 的 各 种 特性 的 识 
别 、 跟 踪 和 描述 。 机 器 人 手册 中 第 3 篇 涵盖 了 机 融 人 
中 使 用 最 典型 的 传感器 和 使 用 这 些 传 感 器 的 基本 
过 程 。 

机 器 人 经 常 被 定义 为 一 种 从 感知 到 执行 动作 的 
智能 耦合 。 本 手册 的 第 3 篇 是 对 第 2 篇 的 补充 ， 介 
绍 了 这 种 耦合 的 所 有 实例 ， 涉 及 智能 的 传 感 和 机 构 。 

这 部 分 内 容 是 在 第 1 篇 的 基础 上 建立 的 ， 特 别 
是 第 4 音 “ 传 感 与 估计” 。 这 部 分 内 容 与 后 面 的 系 
统 和 应 用 的 章节 联系 紧密 。 第 30 章 “ 和 触觉 ”与 
“ 力 和 触觉 传 感 ”的 章节 紧密 相关 。 第 36 章 关 于 世 
界 建 模 的 内 容 是 建立 在 传感器 模型 和 在 第 25 BE BER 
的 融合 方法 的 基础 上 的 。 第 37 章 关 于 同时 定位 和 建 
图 也 是 如 此 。 第 62 章 介绍 了 从 神经 系统 科学 中 提出 
的 结果 如 何 运 用 到 机 器 人 技术 中 ， 并 有 许多 结合 到 
一 起 的 不 同 的 感觉 形态 以 及 将 这 些 技术 融合 到 机 天 
人 中 的 表现 等 内 容 。 最 后 ， 第 63 章 介绍 了 运用 人 类 
视觉 传 感 和 感知 相关 的 机 器 人 方法 。 这 些 方法 是 许 


内 部 状态 的 这 种 基本 能 力 成 为 决策 和 执行 这 一 代 
机 器 人 的 基础 。 

第 21 章 声 呐 感 测 涵盖 了 以 声音 信息 为 基础 的 测 
距 技 术 和 物体 检测 技术 。 值 得 注意 的 是 ， 声 音 传 播 
比 光 传 播 慢 ， 因 此 电子 产品 更 容易 使 用 或 者 说 制造 
成 本 更 便宜 。 在 这 部 分 解释 了 为 什么 很 多 为 移动 平 
合 建 图 和 估计 位 置 的 相当 早期 工作 是 基于 超声 波 声 
呐 的 。 声 呐 仍 是 一 个 水 下 应 用 的 主导 模式 并 且 它 党 
常 为 基本 建 图 提供 了 一 种 具有 良好 经 济 效益 的 解决 
方案 。 
第 22 章 距 离 传感器 涵盖 了 基于 光 的 距离 佑 测 传 
感 噩 的 应 用 。 最 近 可 以 看 到 ， 激 光 雷 达 的 使 用 在 普及 
上 已 经 有 了 相当 大 的 增长 。 基 于 激光 的 传 感 占 是 一 种 
主动 传感器 ， 该 系统 将 某 种 形式 的 能 量 投射 到 环境 
中 ， 然 后 对 返回 的 信息 进行 测量 ， 这 种 技术 允许 我 们 
使 用 匹配 技术 来 简化 数据 间 联 系 问 题 ， 从 而 该 技术 能 
够 应 用 在 更 多 噪声 的 环境 中 。 测 距 系统 也 可 以 采用 多 
目 系 统 ， 例 如 使 用 成 对 摄像 机 构建 的 双 目 系统 中 。 本 
章 对 主动 测 距 和 被 动 测 距 两 种 不 同 的 方法 都 进行 了 


介绍 。 


第 23 章 三 维 视觉 及 识别 涵盖 了 基于 图 像 数 据 的 
物体 三 维 建 模 和 识别 的 方法 。 毫 无 疑问 ， 视 觉 是 最 柔 
性 和 令 人 信服 的 传 感 方式 。 它 在 未 来 的 应 用 具有 很 大 
的 发 展 潜力 。 另 一 方面 ， 因 为 在 混乱 的 环境 中 检测 物 
体 相 当 困难 ， 所 以 柔性 位 置 和 姿态 也 是 一 项 挑战 。 本 
章 主要 介绍 物体 视觉 建 模 方法 和 物体 识别 的 主要 步 又 
和 方法 。 
第 24 章 视觉 伺服 与 视觉 跟踪 介绍 了 以 图 像 数据 


多 运用 在 机 器 人 视觉 的 技术 基础 。 在 23 章 和 24 章 
也 有 相关 的 讨论 。 

本 篇 包含 的 章节 讲述 了 各 种 主要 的 传 感 方式 ， 从 
触觉 、 自 身 感觉 到 测 距 和 视觉 感知 。 

第 19 章 力 和 触觉 传感器 讨论 了 与 外 部 环境 中 的 
物体 相 接触 以 及 作为 反作用 力 的 检测 。 力 传 感 对 于 许 
多 高 精密 装配 任务 的 完成 是 必 不 可 少 的 ， 但 是 越 来 越 
多 的 情况 是 对 那些 非 刚性 物体 的 力 传 感 ， 例 如 ， 应 用 
在 医疗 领域 。 因 此 ， 接 触 和 力 传 感 成 为 抓 取 和 操作 任 
务 的 关键 。 
第 20 章 惯性 传感器 、 全 球 定位 系统 和 里 程 仪 
涵盖 了 基于 从 加 速 力 ， 轴 式 / 轮 式 编码 器 直接 佑 计 
或 者 通过 间接 利用 外 部 参考 系统 (如 GPS, AE RK 
定位 系统 ) 来 实现 自我 运动 佑 测 的 方法 。 机 器 人 
系统 的 指令 偏 移 和 延误 可 能 是 由 于 相互 间 缺 乏 联 
系 ， 但 也 可 能 由 于 物质 的 变化 ， 或 者 由 于 温度 的 
影响 等 。 因 此 ， 利 用 自身 感觉 去 佑 测 自 我 运动 和 


为 基础 的 跟踪 和 控制 的 主要 方法 。 对 象 跟踪 在 许多 用 
以 捕 提 或 躲避 物体 的 应 用 中 都 是 必 不 可 少 的 。 视 觉 伺 
服 讨论 控制 到 达 一 个 目标 位 置 的 问题 ， 该 位 置 常 与 抓 
取 一 个 物体 相 联系 。 本 章 内 容 介 绍 了 主要 的 跟踪 技术 
以 及 视觉 伺服 的 三 个 主要 方法 。 
第 25 章 多 传感器 数据 融合 ， 即 跨越 空间 和 时 间 
言 息 的 集成 问题 。 传 感 器 数据 一 般 会 伴随 各 种 形式 的 
噪声 干扰 存在 ， 而 且 经 常 需要 将 来 自 多 个 传感器 和 不 
同时 间 所 获取 的 数据 集成 起 来 ， 以 便于 提供 可 靠 和 准 
确 的 估计 。 本 章 介 绍 传感器 融合 的 主要 技术 并 给 出 在 
后 续 章 节 将 会 用 到 的 数学 框架 。 

由 于 材料 学 与 电子 学 方面 得 发 展 变化 ， 传 感 器 
领域 正在 迅速 改变 。 在 最 近 十 年 ， 在 激光 测 距 与 视 
觉 传 感 器 方面 的 主要 变化 已 经 被 应 用 了 。 此 外 ， 计 
算 机 资源 的 急剧 变化 也 允许 进行 更 先进 的 数据 处 理 
从 而 生成 更 先进 的 感知 系统 。 可 获得 的 更 加 便宜 、 
可 靠 和 准确 的 传 感 也 正在 影响 着 机 器 人 学 的 其 他 领 
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域 。 为 了 避免 传 感 ， 早 期 的 机 器 人 被 建造 成 具有 最 变 得 更 安全 ， 更 便宜 和 更 有 效 。 传 感 与 驱动 的 集 
大 的 刚度 。 今天， 柔性 机 器 人 为 了 实现 高 精度 和 保 。 ”成 ,尤其 是 加 上 新 的 纳米 技术 ,将 会 在 下 一 个 十 年 
持 低 成 本 正在 依靠 内 部 控制 闭环 中 的 传感器 。 毫 无 显著 改变 机 器 人 技术 。 

疑问 ， 这 是 一 个 会 继续 的 趋势 ， 因 为 ， 和 柔性 机 器 人 
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本 章 是 对 力 和 触觉 感 测 的 概述 ， 并 以 触觉 感 测 为 
介绍 重点 。 我 们 首先 给 出 一 些 选择 触觉 传感器 的 基本 
考虑 因素 ， 然 后 对 多 种 类 型 的 传感器 进行 了 评述 ， 这 
些 传 感 融 包括 接近 、 运 动 、 力 、 动 态 、 接 触 、 皮 肤 变 
形 、 热 觉 和 压力 传 感 带 。 我 们 还 评述 了 各 种 适用 于 每 
种 大 的 传感器 类 型 的 变换 方法 。 根 据 这 些 类 型 传感器 
所 提供 的 信息 ， 我 们 分 析 了 其 是 否 是 最 适合 于 一 般 操 
作 、 表 面 探测 还 是 响应 外 部 作用 所 产生 的 接触 。 

关于 触觉 信息 的 解释 ， 我 们 介绍 了 一 般 问题 描 
述 并 给 出 两 个 简短 的 算 例 。 第 一 个 算 例 是 关于 本 征 触 
觉 感 测 的 ， 即 估算 接触 位 置 和 力 传感器 所 感知 的 力 。 
第 二 个 是 关于 接触 压力 的 感 测 ， 即 利用 弹性 表皮 上 的 
传感器 阵列 来 估算 表面 正 应 力 和 剪 切 应 力 的 分 布 。 

本 章 最 后 简要 讨论 了 在 耐 损伤 触觉 传感器 的 封 
装 和 制造 方面 仍 需 解决 的 难题 。 
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触觉 感 测 已 经 成 为 机 器 人 的 一 个 组 件 ， 与 视觉 用 
于 机 器 人 的 时 间 大 致 相当 。 视 觉 在 硬件 和 软件 方面 都 
已 取得 巨大 的 进展 ， 现 在 广泛 地 用 于 工业 和 移动 机 器 
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地 接收 关于 材料 和 表面 特征 的 触觉 信息 (例如 硬度 、 
热传导 性 、 摩 擦 力 、 粗 糙 程 度 等 ) ， 以 帮助 我 们 识别 
物体 。 如 果 不 去 触摸 ， 仅 靠 观 察 我 们 可 能 很 难 分 别 天 
然 皮 革 和 合成 皮革 。 最 后 ， 从 周围 神经 病变 (一 种 


人 的 应 用 中 。 但 是 与 视觉 相 比 ， 触 觉 感 测 看 起 来 还 需 
要 若干 年 才能 广泛 应 用 。 因 此 ， 在 评述 当前 的 技术 与 
方法 之 前 ， 有 必要 考虑 一 些 基 本 问题 : 

1) 触觉 感 测 的 重要 性 ? 

2) 触觉 的 用 途 是 什么 ? 

3) 为 什么 它 仍 然 相 对 落后 ? 


糖尿 病 的 并 发 症 ) 病人 身上 可 以 看 出 触觉 响应 的 重 
要 性 ， 由 于 不 能 区 分 是 轻柔 接触 还 是 撞击 ， 他 们 会 意 
外 地 伤害 到 自己 。 

如 图 19.1 所 示 ， 相 同 的 功能 分 类 也 可 应 用 于 机 
器 人 。 然 而 ， 相 比 于 每 平方 厘米 的 皮肤 上 就 拥有 成 千 


在 自然 界 中 ， 触 觉 是 一 种 基本 生存 工具 。 即 使 
是 最 简单 的 生物 都 具有 大 量 的 机 械 性 感受 器 来 探索 
和 响应 外 界 的 各 种 刺激 。 就 人 类 来 说 ， 触 觉 感 测 对 
于 操作 、 探 测 、 响 应 三 种 不 同行 为 是 必 不 可 少 的 。 
触觉 感 测 对 于 操作 的 重要 性 在 精细 动作 作业 中 体现 
的 是 最 明显 的 。 当 我 们 冻 僵 时 ， 像 扣 衬 衫 纽扣 这 样 
的 任务 也 变 成 一 个 令 人 诅 丧 的 操作 。 主 要 问题 在 于 
缺乏 感 测 ， 我 们 的 肌肉 温暖 地 贴 附 在 衣 袖 里 ， 只 受 
到 轻微 影响 ， 但 是 我 们 皮肤 的 机 械 性 感受 器 却 被 麻 


上 万 的 机 械 性 感受 器 的 动物 ， 即 使 最 复杂 精细 的 机 器 
人 也 显得 很 逊色 。 和 视觉 比 起 来 ， 触 觉 感 测 技术 发 展 
落后 的 一 个 原因 就 是 没有 类 似 于 电荷 耦合 器 件 
(CCD) 或 金属 氧化 物 半 导体 (CMOS) 光学 阵列 那 
样 的 触觉 装置 。 相 反 ， 触 觉 传感器 获取 信息 是 通过 物 
理 相互 作用 。 它 们 必须 被 戏 入 到 具有 一 定 柔 性 的 表皮 
当中 ， 和 皮肤 表面 局 部 吻合 ， 并 具有 适当 的 摩 氛 可 以 
安全 地 握 住 目标 。 传 感 器 和 皮肤 也 必须 足够 坚韧 ， 从 
而 能 够 承受 反复 的 碰撞 和 磨损 。 和 成 像 平面 就 在 照相 


痹 了 ， 使 我 们 的 动作 变 得 笨拙 。 对 于 探测 ， 我 们 连续 


机 里 面 不 同 ， 触 觉 传 感 器 必须 分 布 于 机 器 人 附件 的 外 
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操作 : 抓 取 力 控制 ; 接触 位 置 与 运动 
学 ; 稳定 性 评价 


探测 : 表面 纹理 ; 摩擦 和 硬度 ; 热 特 
性 ; 局 部 特性 


响应 : 检测 与 回应 外 部 作用 所 产生 
的 接触 


图 19. 1 触觉 感 测 在 机 器 人 中 的 应 用 


面 ， 并 且 在 一 些 地 方 具有 特别 高 的 分 布 密度 ， 比 如 指 
尖 。 因 此 ， 和 触觉 传感器 的 引线 又 成 为 另 一 个 艰巨 的 
挑战 。 

尽管 如 此 ， 在 过 去 的 20 多 年 中 ,在 触觉 传感器 
的 设计 和 配置 方面 仍 取得 了 长 足 的 进步 。 在 下 面 的 几 
个 小 节 里 我 们 将 综述 触觉 传感器 主要 的 功能 类 型 ， 并 
讨论 它们 的 相对 优势 和 局 限 性 。 展 望 未 来 ， 新 的 制造 
技术 为 新 型 人 工 皮 肤 材 料 提供 了 可 能 性 ， 这 种 材料 具 
有 集成 传感器 、 传 感 器 信号 变换 的 本 地 化 处 理 和 能 减 
少 引线 的 总 线 通信 。 


表 19.1 触觉 传感器 形式 及 常见 的 转换 类 型 


关于 接触 感 测 的 研究 有 大 量 的 文献 ， 最 近 的 一 般 
性 综述 有 参考 文献 [19.1] 和 [19.2]， 它 们 也 引用 
了 20 世纪 80 ~ 90 年 代 的 一 些 老 的 综述 文献 。 


19.1 传感器 类 型 


这 部 分 简要 概括 了 五 种 主要 传感器 类 型 : 本 体 
感受 、 运 动 、 力 、 动 态 触觉 和 阵列 触觉 传 感 涡 。 其 
中 的 前 三 种 类 型 传感器 ， 与 能 提供 热力 学 和 材料 成 
分 数据 的 接触 传 感 占 一 起 进行 了 基本 评述 。 但 是 ， 
评述 重点 放 在 能 够 提供 机 械 感受 作用 的 触觉 传感器 
上 。 表 19. 1 提供 了 对 这 些 触觉 传 感 占 的 一 个 综述 。 
在 讨论 触觉 传感器 时 ， 有 必要 先 分 析 那 些 只 能 通过 
与 周围 环境 接触 才能 感 测 的 基本 物理 量 。 用 接触 传 
感 带 测量 的 最 重要 的 物理 量 是 形状 和 力 。 其 中 每 种 
量 要 么 检测 为 机 器 人 一 些 部 件 的 平均 量 ， 要 么 为 在 
接触 面积 上 能 够 空间 分 辩 的 分 布 量 。 在 本 章 中 ， 我 
们 依照 研究 人 类 接触 感觉 的 惯例 ， 并 用 接触 感 测 这 
个 术语 来 特 指 上 述 两 种 模式 的 组 合 。 用 于 测量 平均 
或 合成 量 的 装置 有 时 称 为 内 部 传 感 融 或 本 征 传 感 器 。 
这 些 传感器 的 基础 是 力 感 测 ， 它 将 先 于 触觉 阵列 传 
感 器 讨论 。 
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19.1.1 本 体感 受 和 接近 感 测 


本 体感 受 感 测 是 指 能 够 提供 关于 构件 的 合力 或 运 
动 信息 的 传感器 ， 其 类 似 于 在 人 体 中 能 够 提供 有 关 肌 
腿 张力 和 关节 运动 信息 的 感受 器 。 一 般 而 言 ， 机 器 人 
空间 本 体感 受信 息 的 主要 来 源 于 关节 角度 和 力 -力矩 
传感器 。 因 为 角度 传感器 ， 像 电位 计 、 编 码 器 和 旋转 
变压器 都 已 是 相当 成 熟 的 技术 ， 这 里 不 再 讨论 。 取 而 
代 之 ， 提 供 了 关于 利用 触须 和 触角 进行 接近 感 测 以 及 
非 接触 接近 感 测 的 简要 评述 。 力 - 力 抢 传感器 则 在 
19.1.4 中 进行 更 为 详细 地 讨论 。 

1. 触须 和 触角 传感器 

触须 或 触角 传感器 实质 上 是 本 体感 受 和 触觉 信息 
的 混合 。 对 这 种 传 感 形 式 的 研究 始 于 20 世纪 90 年 代 
早期 ， 比 如 ，Russell'* 引 研 制 了 一 种 附着 在 机 器 人 
手臂 上 来 探测 它 周围 环境 的 触须 传感器 ， 它 具有 一 个 
根部 角度 传感器 和 末梢 接触 传感器 。 另 一 个 来 自 
Kaneko 等 人 "的 例子 是 最 早 的 主动 触角 感 测 实 例 
之 一 。Kaneko 等 人 把 一 个 硬 弹 性 钢 触 角 固 定 在 一 个 
单 自 由 度 旋 转轴 上 ， 使 触角 像 昆 虫 那样 左右 扫 动 。 这 
种 扫 掠 运动 ， 配 合 关节 角度 传感器 和 转 矩 传 感 需 一 起 
来 对 磁 到 的 接触 进行 评估 。Clement 和 Rahn!” RH 
了 和 Kaneko 相似 的 方法 ,但 是 它们 给 触须 的 扫 掠 模 
式 增加 了 一 个 额外 的 自由 度 。Clement 和 Rahn 采用 电 
动 万 向 节 在 两 个 自由 度 上 驱动 弹性 钢 触 须 来 探测 目 
bs, Cowan 等 人 '，**”1 使 用 多 段 压 阻 式 触角 来 辅助 一 个 
仿 昆 虫 六 足 机 器 人 完成 沿 墙 运动 控制 任务 。 

对 于 许多 动物 ， 触 须 或 触角 提供 了 非常 精确 的 接 


触感 知 和 本 体感 受信 息 。 例 如 ， 丹 螂 可 以 控制 自己 沿 
弯曲 的 墙壁 以 每 秒 20 倍 自己 体 长 的 速度 行进 ， 仅 
仅 借 助 于 从 它 的 触角 获得 的 位 置 和 速度 信息 。 其 他 昆 
虫 ， 像 节肢 动物 则 借助 于 外 骨 旷 上 的 大 量 纤毛 感应 器 
来 定位 接触 。 

2. 接近 觉 

尽管 严格 说 来 ， 接 近 觉 感 测 并 不 能 被 归 入 触觉 感 
测 这 一 类 ， 但 由 于 有 许多 研究 者 把 各 种 接近 传感器 用 
于 机 器 人 手臂 和 周围 环境 的 碰撞 检测 应 用 中 ， 因 此 我 
们 在 这 里 简要 评述 一 下 相关 技术 。 这 个 应 用 中 使 用 的 
有 三 种 主要 的 传感器 技术 ， 包 括 电 容 反 射 、 红 外 
(IR). 光学 和 超声 传感器 。Vranish 等 人 开发 出 一 种 早 
期 的 电容 反射 式 传感器 用 于 地 面 固定 机 器 人 和 周围 环 
Se fea] RE AE?) 。Lumelsky 研究 团队 提出 了 置 于 
人 造 皮 肤 中 的 分 布 式 红外 发 射 - 接收 组 的 例子 ， 用 于 
Bern 9009 。 参 考 文献 【19.32] 介绍 了 使 用 光 
纤 技 术 的 最 新 设计 。 还 有 其 他 人 研究 者 也 开发 出 同时 使 
用 分 布 式 超声 和 红外 光学 传感器 的 机 器 人 皮肤 用 于 避 
fi 9391. Wegerif 和 Rosinski 对 这 三 种 接近 感 测 技术 
的 性 能 进行 了 比较 *。 对 各 种 传感器 的 详细 评述 
见 第 21 章 的 声呐 感 测 和 第 22 章 的 距离 传感器 。 


19.1.2 其 他 接触 传感器 


还 有 多 种 其 他 基于 接触 的 传 感 希 ， 它 们 能 够 辨识 
目标 的 一 些 特 性 ， 例 如 电磁 特性 、 密 度 (通过 超声 
波 ) ， 或 化 学 成 分 〈 比 照 动 物 的 味 党 和 嗅觉 ) 。 这 些 
传感器 不 在 本 章 的 讨论 范围 之 内 ， 在 关于 仿生 机 天 人 
的 第 60 章 中 将 简要 讨论 有 关 嗅 党 和 味觉 的 仿生 化 学 
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传感器 。 考 虑 到 完整 性 ， 热 传感器 和 材料 成 分 传感器 
也 将 在 下 面 简要 的 讨论 。 

1. 热 传 感 器 

热 传 感 器 除了 用 于 测量 物体 表面 温度 外 也 可 以 用 
于 确定 材料 成 分 。 因 为 在 同一 环境 中 的 大 多 数 物体 都 
处 于 大 致 相同 的 (房间 ) 温度 ， 因 此 包含 有 热源 的 
温度 传感器 可 以 探测 物体 的 热 吸收 率 。 这 些 数 据 可 以 
提供 有 关 物 体 对 象 的 比热容 和 材料 的 热传导 率 的 信 
息 ， 从 而 使 确定 制造 的 原材料 变 得 简单 ， 如 区 分 是 金 
属 还 是 塑料 。 

Buttazzo 等 '* 当 注意 到 他 们 用 于 触觉 感 测 系 统 的 
压 电 聚合 物 也 是 强 热电 物质 ， 于 是 使 用 了 其 中 的 表面 
层 作 为 热 传 感 器 。 也 有 使 用 热 敏 电阻 作为 换 能 器 的 其 
他 传感器 ， 比 如 Siegel 4597 4p ZRBU 4 x 4 阵列 以 及 
Russell ^7 f] 2 x 10 阵列 。 一 些 系 统 特地 提供 一 个 内 
部 参考 温度 ， 并 用 其 与 外 界 温度 差 值 作为 检测 接触 的 
FHI) | 但 是 ， 当 外 界 物体 和 参考 温度 相同 的 


| 


角 的 构成 元 件 "*” 。Kaneko 关于 手指 手势 可 变性 的 
研究 是 一 个 组 合 关节 角度 和 接触 状态 信息 用 于 
操作 的 例子 。 


19.1.4 力 和 负载 感 测 


1. 驱动 力 传感器 

对 于 一 些 驱 动 装置 ， 比 如 伺服 电动 机 ， 可 以 直接 
通过 测量 电动 机 电流 来 测量 驱动 力 (典型 的 做 法 是 
用 一 个 检测 电阻 和 电动 机 串联 来 测量 检测 电阻 两 端的 
电压 降 ) 。 但 是 ， 电 动机 通常 是 通过 减速 器 与 机 器 人 
手臂 连接 ， 减 速 器 的 输出 /输入 效率 为 60% 或 更 低 ， 
所 以 测量 减速 器 输出 端的 转 矩 通常 更 为 准确 。 这 个 问 
题 的 解决 方案 包括 轴 转 和 矩 负载 单元 〈 通 常 采 用 应 变 
片 ) 或 机 器 人 关节 处 的 机 械 结构 ， 这 种 结构 的 挠 度 
可 以 使 用 电磁 或 光学 传感器 测量 。 对 于 绳索 或 钢 缆 驱 
动 的 手臂 和 手 扑 ， 测 量 索 张力 是 很 有 用 处 的 ， 不 仅 可 
用 于 补偿 传动 系统 的 摩擦 力 ， 而 且 也 可 以 作为 测量 


Ne 


话 就 不 能 被 检测 到 。 大 多 数 这 类 传感器 有 一 层 相 当 厚 
的 皮肤 覆盖 在 热 敏 元 件 上 ， 从 而 保护 精细 组 件 并 且 提 


作用 在 工具 附件 上 负载 的 方法 '”* 。 当 手指 或 手臂 
与 外 界 环 境 中 的 物体 接触 时 ， 索 张力 感 测 可 以 用 于 蔡 


供 一 块 共 形 表面 ， 不 过 这 些 都 是 以 降低 反应 时 间 为 代 
价 的 。 

在 Engel 等 人 的 研究 工作 中 可 以 发 现 一 个 更 新 的 
关于 热 觉 感 测 的 例子 ， 他 们 最 近 公 布 了 一 个 柔性 触觉 
传感器 的 设计 ， 包 括 在 微 加 工 聚 合 物 基底 上 集成 的 金 
膜 加 热 装置 和 一 个 阻抗 温度 装置 (RTDs) P5, H 
F Engel 等 人 提供 的 是 一 个 高 度 集成 的 设计 ， 这 种 敏 
感 元 件 依然 很 脆弱 。 因 此 ， 在 这 些 系统 中 综合 考虑 结 
构 ， 性 能 以 及 对 热 敏 元 件 保护 的 均衡 仍然 是 一 个 持续 
的 挑战 。 

2. 材料 成 分 传感器 

关于 材料 成 分 传 感 顺 也 有 一 些 研 究 工作 。 通 过 模 
拟人 类 的 触觉 与 嗅觉 ， 液 相 和 气相 化 学 传感器 能 大 体 
测定 物体 表面 的 化 学 成 分 ”3 。 电 磁场 感 测 是 另 
外 一 种 提供 特性 的 感 测 模式 ， 它 使 用 涡流 和 霍 尔 效应 
探 针 测量 铁 磁性 和 导电 性 1。 
运动 传感器 

尽管 运动 传感器 通常 并 不 被 看 做 是 触觉 传感器 ， 
然而 这 些 探 测 手臂 位 置信 息 的 传感器 可 以 提供 给 机 器 
人 几何 信息 用 于 操纵 和 探测 ， 尤 其 手臂 上 还 装 有 用 于 
记录 接触 事件 的 传感器 的 时 候 。 这 些 传 感 咒 包括 几乎 
所 有 机 器 人 都 安装 的 关节 角度 编码 器 ， 以 及 电位 计 、 
旋转 变压器 和 其 他 关节 角度 测量 装置 。 对 于 不 承受 大 
幅度 旋转 的 手臂 ,可 以 租 入 柔性 结构 ， 比 如 在 
19. 1. 1 部 分 讨论 过 的 Cowan 等 人 所 使 用 的 压 阻 式 触 
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代 末 端 负载 感 测 来 测量 接触 力 分 量 。 当 然 ， 仅仅 只 有 
那些 能 产生 很 大 转 矩 的 分 量 能 被 测量 出 来 。 在 
15.3.2 部 分 (机 器 人 手 : 传感器 ) 包括 更 多 关于 索 
张力 测量 的 细节 。 

2. 力 传感器 

当 驱 动力 传感器 不 足以 测量 由 工具 附件 所 施加 或 
施加 于 工具 附件 上 的 力 时 ， 通 常会 采用 单独 的 力 传 感 
器 。 这 种 传感器 经 常安 装 在 机 器 人 的 基 关 节 或 手腕 
处 ， 也 可 以 分 布 于 机 器 人 各 连 杆 处 。 
原则 上 ， 任 何 类 型 的 多 轴 负 载 单元 都 可 以 用 于 机 
RERI- IERM, Rm, INI, REFRA R 
好 的 静态 响应 性 能 的 要 求 ， 排 除了 市 场 上 的 大 多 数 传 
感 器 。 除 了 设计 安装 在 腕 关节 夹 持 器 上 的 力 传感器 得 
FRAN KEYS?! ， 也 有 一 些 设 计 是 用 于 灵巧 手 
的 指 尖 传 感 句 。 通 常 这 些 传感器 是 基于 安装 于 金属 弹 
性 体 上 的 应 变 片 的 3， 相当 坚固 。Sindent 和 
Boid 给 出 了 一 种 基于 测量 弹性 体 电介质 电容 的 平 
面 六 轴 力 - 力矩 传感器 。 力 传感器 设计 需要 考虑 的 因 
RAME Bör, WE, UKAŽ, FEEMERK, 
Dario 等 给 出 了 一 个 集成 的 机 器 人 手指 尖 : 包括 一 个 
集成 的 力 感 测 电阻 压力 阵列 、 压 电 陶 瓷 双 唱 片 动态 传 
RASA eae ee | UE, Edin GPO FR 
出 微型 多 轴 指 尖 力 传感器 〈 见 图 19.2) 。 对 于 有 抗 电 
EMR FS FER AY A, Park” 给 出 了 一 种 在 机 器 
人 指 尖 舱 入 光纤 光栅 作为 光学 应 变 仪 的 设计 。Bic- 
chi!!! 和 Uchiyama 等 '* 总 体 上 讨论 了 多 轴 力 传 感 
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LIEU, 在 一 项 对 采用 振动 来 检测 滑动 的 方法 可 行 性 的 系 


图 19.2 用 于 仿生 手 的 微型 指 尖 力 -力矩 传感器 
(经 参考 文献 [19. 47 ] HEAT) 


值得 注意 的 是 使 用 指 尖 负载 传感器 并 不 只 是 能 
获得 力 信息 。 力 传感器 的 信息 可 以 和 指 尖 几何 形状 知 
识 相 结合 来 确定 接触 点 位 置 ， 如 图 19.3 所 示 。 这 种 
接触 感 测 的 方法 被 称 为 本 征 触觉 感 测 ， 最 先是 由 Bic- 
chi 等 9 河 提 出 的 。Son 等 (* 蔬 给 出 了 本 征 的 和 外 在 
的 (比如 使 用 分 布 式 的 接触 传感器 ) 接触 感 测 的 比 
较 。 这 些 还 将 在 19. 2. 1 节 中 进一步 详细 讨论 。 


动态 触觉 
传感器 


图 19.3 具有 指 尖 力 和 触觉 感 测 的 机 器 人 手 
( 力 传感器 测 得 的 信息 与 指 尖 几何 形状 知识 相 结 合 
来 确定 接触 位 置 ， 称 之 为 本 征 触觉 感 测 。 ) 


19.1.5 动态 触觉 传感器 


早期 基于 位 移 的 专用 滑动 传 感 吕 是 检测 移动 元 件 
的 运动 ， 比 如 夹 持 絮 表面 的 滚轮 或 针 状 物 (例如 ， 
Ueda 等 ”1 ) 。 最 新 的 方法 使 用 一 个 热 传 感 顺和 一 
个 热源 ， 当 被 抓 的 物体 开始 滑动 时 ， 先 前 传感器 下 温 
暖 的 表面 移 开 了 ， 导 致 传 感 顺 下 方 表面 的 温度 下 降 。 
非 接触 光学 方法 使 用 相关 性 来 检测 物体 表面 的 运 


统 研究 中 ，Rebman 和 Kallhammer!® 5 使 用 阵列 传 感 
器 中 的 单个 元 件 来 检测 接触 表面 的 法 向 振动 。Dario 
和 Derossi^ ^ 9! 以 及 Cutkosky 和 Howe 5 指出 位 于 接 
触 面 附近 的 压 电 聚合 物 对 振动 非常 敏感 ， 可 以 用 于 滑 
动 检测 。Howe 和 Cutkosky' 展示 了 使 用 一 个 微型 
加 速 计 来 感 测 柔 顺 传 感 絮 皮肤 的 微小 振动 的 方法 ， 该 
方法 能 够 有 效 地 检测 出 还 处 于 初期 阶段 的 滑动 。 对 于 
金属 夹 持 器 抓 住 的 坚硬 物体 ， 声 发 射 可 以 测 出 初期 的 
滑动 中 — Morel] 79 和 Tremblay 9? HERE f 38 
动 传感器 在 抓 取 力 控制 中 的 应 用 。 

Buttazzo 等 (“1 研制 了 一 个 纹理 感 测 指甲 作为 仿 
人 化 触觉 感 测 系统 的 一 部 分 。 硬 质 塑料 指甲 的 底部 是 
一 个 压 电 元 件 ， 当 其 在 纹理 表面 上 被 拖 动 时 能 够 产生 
很 强 的 信号 。 在 有 关 形 状 或 滑动 感 测 的 内 容 中 描述 的 
应 力 速 率 传感器 ("*”%] eR m pe Pe eod o on 
和 感应 振动 传感器 "也 可 以 响应 物体 滑 过 精细 表 
面 所 产生 的 微小 振动 。 最 近 对 这 些 传 感 器 的 改进 包括 
压 电 陶 次 双 唱 片 动态 传感器 、 带 集成 FSR 的 压力 阵 
IMH- 71 & fc a 77, Yamada 等 9! JE iH — 
种 压 电 人 造 皮肤 ， 能 够 区 分 出 转动 和 滑动 。Waldron 
等 1% 引 描述 了 一 种 集成 皮肤 加 速度 传感器 和 压 电 阵 
列 的 触 党 传感器 用 于 远程 皮肤 医学 应 用 。Fllis 也 研 
究 了 采用 特 高 分 辩 率 触觉 阵列 的 数据 来 识别 表面 纹 
Fp] 。Omata 和 Terunuma 开发 了 一 种 测量 柔性 变 
化 量 的 传 感 咒 ， 该 变化 是 通过 检测 一 个 主动 压 电 元 件 
的 谐振 频率 的 变化 得 到 的 ”| 。 


19.1.6 阵列 传感器 


阵列 传 感 顺 可 再 分 为 两 种 主要 类 型 : 测量 压力 的 
和 测量 传感器 皮肤 表面 挠 度 的 。 触 觉 压力 阵列 是 目前 
更 为 普遍 的 。 压 力 阵列 往往 是 相对 坚硬 的 ， 采 用 多 种 
转换 方法 和 固体 力学 来 计算 接触 压力 分 布 。 压 力 阵 列 
的 皮肤 变形 / 挠 度 大 约 为 1 ~2mm。 男 一 方面 皮肤 
挠 度 传感器 的 结构 形式 允许 接触 过 程 中 传感器 皮肤 的 
明显 变形 ， 这 有 助 于 提高 抓 取 的 稳定 性 (参见 第 27 
和 第 28 章 ) 。 

在 过 去 15 年 的 文献 中 有 许多 种 触觉 阵列 传感器 
! 现 ,但 在 它们 中 只 有 很 少 一 些 能 适用 于 灵巧 手 。 对 
于 换 能 右 而 言 ， 最 基本 的 要 求 就 是 能 够 从 柔顺 弹性 层 
下 面 清晰 地 复原 接触 面 上 或 者 形状 或 者 压力 的 分 布 。 


O 


动 ””。 许 多 研究 者 提出 使 用 传统 阵列 进行 滑动 检 
测 ， 但 是 阵列 必须 具有 足够 高 的 分 辨 率 和 扫描 频率 ， 
从 而 能 足够 迅速 地 检测 到 物体 特征 的 运动 ， 以 阻止 抓 
取 物 体 的 滑落 。 


这 可 以 通过 直接 感 测 形状 ”7” 或 感 测 表面 下 应 变 
的 多 个 分 量 '"”" 来 实现 。 然 后 可 以 采用 固体 力学 
模型 (19.2.2 部 分 ) 来 确定 所 要 得 到 的 检测 量 。 尽 
管 目 前 所 开发 的 模型 中 使 用 的 方法 是 非常 成 功 的 ， 但 
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它们 必须 扩展 到 三 维 并 且 包 含 多 应 变 分 量 。 由 于 这 些 
模型 比较 复杂 ， 实 时 执行 的 问题 也 必须 要 解决 。 

1. 接触 位 置 传感器 

有 许多 触觉 传感器 仅仅 提供 接触 位 置信 息 。 在 超 
声 传 感 融 大 量 运用 之 前 ， 在 移动 机 器 人 的 外 部 机 架 上 
安装 离散 开关 是 很 普遍 的 。 其 他 一 些 研 究 者 还 给 出 使 
用 离散 开关 阵列 的 研究 。 其 中 一 些 传感器 采用 薄膜 开 
关 设 计 的 形式 ， 这 种 设计 可 以 在 键盘 里 找到 。 由 Arai 
等 提出 的 一 个 相 类 似 的 设计 例子 是 透明 开关 ， 它 与 触 
摸 屏 显示 组 合 使 用 "””。 作 为 男 外 一 种 形式 ，Grif- 
fin’! ”描述 了 一 种 由 W. provancher 设计 的 薄膜 开关 
激发 的 接触 开关 阵列 ， 它 由 绝缘 条 隔离 开 的 柔性 电路 
组 成 。 当 压力 使 其 中 一 个 柔性 电路 弯曲 向 男 一 个 时 ， 
就 检测 出 接触 ， 如 图 19. 4a 所 示 。 最 近 Edin 4g ^ 77 
的 研究 展示 了 对 这 个 想法 的 一 个 很 好 的 延伸 ， 把 一 个 
二 维 开关 阵列 圣人 到 仿生 手中 ， 参 见 图 19.4b。 一 
光学 传感器 '* ”| 也 主要 用 作 接 触 位 置 传感器 。 但 是 ， 
它们 也 能 测量 接触 力 的 大 小 ， 所 以 将 在 下 面 触觉 阵列 


传感器 结构 dioe 
ie : = 
侧 视图 PT qm 2 电导 通 


age 装配 好 的 机 器 人 
指 尖 传 感 器 


图 19.4 采用 柔性 印刷 电路 制作 的 接触 开关 阵列 
a) 简单 的 16 x1 开关 阵列 〈 用 于 机 器 人 灵巧 手 的 指 尖 ) 


(W. Provancher 绘制 ) 
接触 开关 阵列 ( 


b) 嵌入 到 仿生 手 皮肤 里 的 
经 参考 文献 [19.47] 许可 ) 


2. 压力 感 测 阵列 

(1) 电容 式 压 感 阵列 ”触觉 压力 阵列 是 最 早 并 
且 最 普 cu qu a 
Fearing 和 Binford'* 在 这 个 领域 开展 了 一 些 早期 的 
pe 


阵列 ， 适 用 于 灵巧 操作 。 这 些 传感器 阵列 由 重生 的 行 
和 列 电 极 组 成 ， 它 们 被 弹性 电 介 ee 
列 。 在 个 别 交叉 点 处 压 紧 行列 隔 板 间 的 电介质 会 导致 
电容 的 变化 。 ee 
C 二 (EA4)/d,， 其 中 e 是 电容 极 板 间 电 介质 的 介 电 党 
数 ，4 是 极 板 的 面积 ，d 是 两 极 板 间 的 距离 。 压 紧 电 
容 极 板 间 电 介质 使 极 板 间 距 d 减少 ， 就 产生 了 对 位 移 
的 线性 响应 。 
通过 适当 的 电路 转换 系统 ， 在 传感器 阵列 中 某 个 
行列 交叉 点 处 对 应 的 特定 区 域 就 可 以 被 分 离 出 来 。 压 
力 可 以 如 Fearing!” P! 所 述 那 样 利 固体 力学 来 计算 。 
类 似 的 电容 式 触觉 阵列 的 例子 可 见于 参考 文献 
[19.10, 11]， 以 及 商品 化 的 例子 中 。 最 近 ，Shi- 
noda 的 团队 研究 了 一 种 导电 织物 来 构成 一 致 堆 码 式 
电容 器 ， 以 更 适 于 覆盖 不 只 是 机 右 人 手 的 更 大 区 
域 '* 中 。 堆 秋 式 电容 传感器 元 件 中 的 织物 电极 交替 
被 硬 或 软 的 聚氨酯 泡沫 分 开 ， 人 允许 一 个 单独 传感器 单 
元 同时 估计 接触 压力 和 接触 面积 。 
(2) 压 阻 式 压 感 阵列 ”很 多 研究 者 研发 出 的 触 
觉 传感器 阵列 实质 上 是 压 阻 式 的。 这 些 传感器 一 般 来 
说 不 是 采用 批量 模 塑 的 导电 橡胶 ， 就 是 采用 压 阻 油 
墨 ， 油 墨 通常 通过 丝 网 印刷 或 压 印 方式 形成 图 案 。 它 
们 都 是 利用 导电 添加 剂 (通常 是 炭 黑 ) 来 产生 导电 / 
压 阻 特性 。 然 而 ， 由 于 这 些 传 感 需 形态 结构 所 呈现 的 


脆弱 性 和 述 滞 现象 ， 一 些 研究 者 又 开发 出 基于 纤维 的 
压 阻 传感器 。 


Russell 中 给 出 了 第 一 个 模 塑 导电 橡胶 触觉 传 
感 器 阵列 ， 由 压 阻 式 结 点 连接 的 导电 橡胶 行列 电极 组 
成 。 然 而 这 种 传感器 存在 严重 的 漂移 和 磁 滞 现象 ， 通 
过 合适 地 选择 模型 材料 来 尽量 最 小 化 这 些 影 响 成 为 后 
来 研究 者 的 研究 热点 '*。 由 于 橡胶 固有 的 迟滞 特 
性 ， 这 些 问 题 并 未 得 到 完全 的 解决 。 但 由 于 便于 制 
造 ， 这 种 感 测 方法 仍然 具有 吸引 力 。 因 此 ， 在 不 需要 
极 高 精度 要 求 的 仿 人 形 机 器 人 的 附件 上 仍 可 以 发 现 这 
种 传感器 的 应 用 | 。 

很 多 研究 者 和 公司 开发 了 出 使 用 导电 (JERE) 
油墨 的 触觉 传 感 顺 ， 通 常 称 为 力 敏 电阻 (FSRs) 。 将 
现成 的 分 立 传感器 (参见 TekscanFlexiforce FSRs) 组 
合成 触觉 感 测 阵 列 是 目前 最 普遍 、 最 简单 也 是 最 方便 
可 用 的 方法 。 然 而 ， 要 得 到 高 集成 度 的 密集 传感器 阵 
列 ， 就 必须 要 定制 加 工 了 。 了 Papakostas 419.43 和 Dario 
Ag 07U ABT 3x QE Pa d P I Da BEC A HS 
用 更 进一步 ，Someyal? 5 研制 出 将 压 阻 式 传感器 阵列 
印刷 在 柔性 聚 酰 亚 胺 薄膜 上 的 机 器 人 皮肤 ， 并 将 图 案 
化 有 机 半导体 用 于 传感器 阵列 的 本 地 放大 。 然 而 ， 尽 
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管 这 些 传感器 阵 列 被 制作 在 柔性 的 基底 上 ， 仍 然 容易 
受到 弯曲 疲劳 的 影响 。 

压 阻 织物 被 研制 用 来 克服 触觉 阵列 中 出 现 的 疲劳 
和 脆弱 性 问题 。De Rossi 4*7. Tognetti 5 等 和 
Shimojoet 等 "5 给 出 了 这 类 传感器 的 一 些 范例 。 这 些 
传感器 往往 比较 大 〈 即 空间 分 辨 率 比较 低 ) ， 一 般 在 
诸如 仿 人 形 机 器 人 的 手臂 和 腿 上 应 用 。 因 为 这 项 技术 
有 蔡 代 传统 织物 的 可 能 性 ， 所 以 它 是 一 项 在 可 穿戴 式 
计算 甚至 智能 衣服 应 用 方面 很 有 前 景 的 技术 。 

最 后 还 有 一 种 不 能 归 和 上述 制作 类 型 中 的 设计 ， 
它 是 由 Kageyama 等 设计 的 一 种 传感器 。 在 他 们 为 用 
于 仿 人 形 机 器 人 所 开发 的 传感器 层 中 ,采用 了 一 个 不 
阻 导电 族 胶 压力 阵列 和 一 个 基于 可 变 接 触 阻 抗 的 多 级 
接触 开关 阵列 。 

(3) MEMS FRIES MALE (MEMS) 技术 对 
于 制造 高 集成 度 封 装 的 触觉 感 测 及 相关 连 线 和 电子 器 
件 是 非常 有 吸引 力 的。 早期 的 咒 件 是 通过 标准 硅 微 加 
工 技术 在 硅 上 制作 的 ， 包 括 由 Kane SE JT BRE 
够 测量 剪 切 力 和 正 压力 的 硅 微 加 可 兼容 CMOS 的 触觉 
阵列 。 这 些 传感器 在 实验 室 能 够 良好 地 运行 ， 但 是 它 
们 太 脆 弱 以 至 于 不 能 在 碰撞 或 恶劣 的 环境 下 工作 。 最 
近 研 究 者 运用 MEMS 技术 制作 具有 柔性 基底 的 传 感 
器 阵列 ， 使 其 适 于 艇 入 弹性 皮肤 当中 。 巾 于 皮肤 的 防 
护 作 用 ， 这 有 利于 提高 耐用 性 。Engel 等 研制 了 带 有 


图 19.5 MEMS 显 微 图 及 其 力 传感器 
a) MEMS 三 轴 触 觉 力 传感器 的 显 微 图 b) MEMS 力 传感器 ， 
被 线 粘 接 到 柔性 电路 并 髓 入 到 硅 橡 胶皮 肤 中 55] 


变形 指 尖 的 早期 研究 工作 之 一 ，””。 他 的 传感器 手 
指使 用 硬 质 衬 底 和 聚氨酯 泡沫 为 传感器 皮肤 提供 恢复 
力 。 导 电 橡 胶 应 变 片 元 件 阵 列 和 它们 的 相互 连接 被 切 
割 成 适当 的 形状 ， 并 且 被 粘 合 到 硅 橡胶 皮肤 的 背面 。 


在 聚 酰 亚 胺 基底 上 生成 的 温度 和 悬臂 元 件 组 合 的 触觉 
ERE) 。 进 行 聚 酰 亚 胺 的 聚合 物 微 加 工 可 以 使 
聚 酰 亚 胺 基底 具有 最 佳 的 柔顺 性 。Noda 和 Shimoy- 
amal? 8 对 这 种 设计 进行 了 一 个 值得 关注 的 变更 。 这 
些 人 研究 者 也 在 他 们 的 阵列 传 感 涡 上 制作 了 悬臂 梁 切 应 
力 元 件 ， 不同 的 是 ， 他 们 在 平面 加 工 工 序 中 采用 镍 铭 
压 电 电阻 来 制作 悬臂 粱 ， 然 后 将 悬臂 粱 从 加 工 基底 释 
放 ， 并 且 在 基底 上 竖立 起 来 就 像 毛 发 被 电磁 场 吸 引 一 
样 ， 随 后 用 聚 氧 代 对 二 甲苯 对 其 覆盖 来 固定 悬臂 梁 
(用 于 感 测 剪 切 力 ) 。 回 到 把 硅 负 载 元 件 用 于 触觉 感 
测 的 想法 上 ，Valdastri 5579 WR T — PPAR PAS (Ue 
作 杆 的 微型 MEMS HERM doo, Hos T iA B) 
性 橡胶 皮肤 〈 见 图 19. 5) 。 这 些 传 感 器 可 以 分 布 在 皮 
肤 表面 下 来 检测 弹性 皮肤 中 复杂 的 应 力 状态 。 

3. 皮肤 挠 度 感 测 

Brocket! ”中 是 首先 提出 使 用 可 变形 薄膜 机 器 人 
指 尖 想法 的 人 之 中 一 员 。 正 如 Shimoga 和 Golden- 
berg'*“1 所 指出 的 ， 使 用 可 变形 指 尖 比 使 用 更 坚硬 的 
机 器 人 指 尖 有 若干 优势 ， 包括: 中 提高 抓 取 的 稳定 
TE; 四 降低 振动 ; 加 降低 做 入 的 传 感 元 件 的 疲劳 。 
Russell 关于 制作 柔性 硅 橡胶 机 器 人 手指 的 研究 是 可 


导电 橡胶 就 是 简单 的 硅 橡 胶 ， 只 是 选择 具有 最 小 力学 
滞后 特性 的 并 混合 了 石墨 。 对 某 一 给 定 行 的 电气 连接 
沿 着 长 度 方向 按 一 定 间 隔 接 和 导电 橡胶 应 变 片 ， 从 而 
细 分 为 几 个 单独 的 应 变 测量 部 分 ， 形 成 一 个 分 压 电 
路 。Russell 展示 了 8 x 1 线性 阵列 和 8 x 5 阵列 的 
结果 。 

Nowlin 使 用 贝 叶 斯 算法 改善 了 可 变形 触觉 传感器 
的 数据 解释 ， 传 感 器 采用 的 是 磁场 感 测 忆 2 | — A 
4 x4 的 磁体 阵列 通过 充满 液体 的 球 ， 支 撑 在 配对 的 
霍 尔 效应 传感器 上 ， 并 与 硬 质 基 质 底 隔离 开 。 霍 尔 效 
应 传感器 测量 局 部 磁场 强度 ， 并 且 越 靠近 磁体 就 会 增 
强 。 但 是 ， 在 接近 传感器 阵列 中 相 邻 的 磁体 时 这 个 关 
系 就 变 得 复杂 了 。 因 此 ， 使 用 贝 叶 斯 算法 组 合 来 自 霍 
尔 效 应 传感器 的 噪声 数据 ,来 估计 可 变形 指 尖 的 薄膜 
gam, 

随后 Russell 和 Parkinson"? ?! 开发 出 通过 一 个 
8 x5 阵 列 能 够 测量 皮肤 形变 的 阻抗 断层 成 像 触 觉 传 感 
器 。 这 种 传感器 由 氧 丁 橡胶 构成 并 充满 蒸馏 水 。 行 和 
列 电极 分 别 由 铜 和 导电 橡胶 制 成 ， 适 于 便 质 基底 和 和 氧 
丁 橡胶 皮肤 。 与 前 面 描述 的 电容 式 触觉 传感器 类 似 ， 
这 种 传感器 采用 多 路 复 用 的 电子 器 件 来 减少 电子 互 连 
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数量 。 方 波 驱 动 器 件 用 来 测量 行 与 列 元 件 间 形成 的 一 
支 水 柱 的 电阻 ， 给 出 一 个 与 当前 皮肤 高 度 成 比例 的 
信号 。 

继 提 出 可 变形 触觉 传感器 的 想法 之 后 ，Ferrier 
和 Brocket'”* "完成 了 一 种 使 用 光学 追踪 的 触觉 传 感 
器 ， 该 传感器 结合 传感器 皮肤 变形 模型 来 估计 传 感 
器 指 尖 皮 肤 形变 。 这 种 指 尖 传 感 器 包含 一 个 聚焦 在 
7 x7 点 阵 上 的 微型 CCD 相机 ， 该 点 阵 被 标记 在 充满 
凝 胶 的 硅 指 尖 薄 膜 内 侧 。 然 后 采用 了 一 种 算法 在 点 
阵 之 上 构造 一 个 13 x 13 栅 格 。 这 种 算法 组 合 运 用 
CCD 相机 所 感 测 的 位 置信 息 和 一 个 力学 模型 摄像 
头 提供 的 是 从 焦点 径 向 地 向 外 沿 着 一 条 直线 的 位 置 ， 
力学 模型 基于 能 量 最 小 化 原则 求解 自 相 机 焦点 起 始 
的 径 向 距离 。 

Provancher 和 Cutkosky 提出 了 另外 一 种 设计 ， 使 
用 压 阻 应 变 片 来 直接 测量 指 尖 薄膜 曲率 '*” ate 
传感器 构建 在 聚 酰 亚 胺 基底 上 ， 使 商用 条 形 
(用 于 研究 应 变 梯度 ) 相互 紧 接着 粘 合 s 
应 变 ， 该 应 变 与 曲率 成 比例 。 — 
操作 的 运动 规划 是 非常 重要 的 。 作 者 提出 了 一 个 数学 
模型 ， 使 用 一 组 基 函 数 和 最 小 二 乘法 来 计算 曲率 空间 


可 用 于 瞬时 摩擦 力 的 测量 所 ?1] 。Ando 等 3 给 出 了 
一 种 更 为 复杂 的 超声 波 传感器 ， 通 过 成 对 的 盘 状 元 件 
能 够 实现 六 自由 度 的 位 移 感 测 ， 每 个 盘 上 使 用 了 四 个 
超声 波 换 能 器 。 

一 些 研究 者 开发 出 了 具有 多 重 感 测 模式 的 传 感 
器 。Siegel 45/9 9! 和 Castelli 99? 24 Hy  — 2625 & fih 
觉 感 测 和 热 感 测 的 传感器 例子 。Shimizu SO" £5 HY 
了 用 于 测量 力 和 物体 硬度 的 传感器 。 这 种 传感器 使 用 
气压 来 驱动 传 感 元 件 主动 地 到 达 物 体 表 面 。 

另 一 种 值得 关注 的 传感器 包含 了 触觉 感 测 和 超 
声 成 像 的 结合 "2 ， 在 此 基础 上 Methil 等 研发 了 一 
种 利用 光 导 触觉 传感器 的 触觉 系统 用 于 进行 乳腺 
检查 。 


19.2 触觉 信息 处 理 
19.2.1 触觉 信息 流 : 触觉 感 测 的 手段 和 


目的 


在 讨论 触觉 信息 处 理 之 前 ， 我 们 首先 回顾 一 下 图 
19.1 中 所 描述 的 三 个 主要 用 途 。 对 于 操作 ， 我 们 首 


he de nt did du d 能 
够 重建 已 变形 的 薄膜 形状 。 一 个 11 x 1 线性 阵列 传 感 
en E. 

4. 其 他 触觉 阵列 传感器 

一 个 光学 触觉 传感器 的 早期 例子 是 由 Maekawa 
等 提出 的 *"”。 他 们 用 一 个 单独 的 光学 位 置 感 测 装 
置 (PSD) 或 一 个 CCD 相机 阵列 来 检测 从 带 有 硅 橡 
胶 保 护 层 的 半球 形 光 波导 指 尖 上 散射 的 光线 位 置 。 光 
在 有 接触 的 位 置 会 产生 散射 。 基 于 一 个 简单 的 模型 ， 
可 以 确定 出 多 个 接触 点 。 对 于 带 纹理 的 皮肤 ， 作 用 力 
的 大 小 也 能 够 估算 出 来 ， 这 是 由 于 接触 面积 会 随 压 力 


要 的 需求 是 接触 位 置 和 接触 力 的 信息 ， 这 样 我 们 就 可 
以 牢固 地 抓 住 物体 并 对 其 施加 适当 的 力 和 动作 。 对 于 
探测 ， 我 们 关注 目标 物体 信息 的 获取 和 整合 ， 包 括 局 
部 儿 何 形状、 硬度、 摩擦、 质地、 热传导 性 等 。 对 于 
响应 ， 我 们 尤其 关注 事件 的 检测 ， 比 如 外 部 作用 导致 
的 接触 ， 以 及 对 它们 类 型 和 大 小 的 评估 。 对 这 些 信息 
的 应 用 往往 相互 关联 的 ， 例 如 ， 我 们 操作 物体 来 达到 
探测 它们 的 目的 ， 我 们 通过 使 用 目标 探测 获得 的 信息 
来 提高 我 们 在 操作 中 对 力 和 运动 的 控制 能 力 。 识 别 接 
触 事 件 对 于 操作 和 探测 来 说 如 同 它 对 于 响应 一 样 的 
重要 。 


El 


按 比例 增加 。 然 而 ,使 用 柔顺 皮肤 覆盖 硬 质 基底 的 指 
尖 存 在 一 个 问题 ， 即 两 种 材料 之 间 的 粘 合 导致 迟滞 现 
象 。 另 外 ， 当 指 尖 滑 过 物体 表面 时 ， 摩 擦 力 会 使 估计 
的 接触 位 置 产生 一 个 偏离 。 

另 一 种 值得 关注 的 触觉 传感器 利用 视觉 追踪 被 内 
入 透明 弹性 体内 的 一 组 球形 标记 ,来 推测 皮肤 材料 由 
于 作用 力 而 产生 的 应 力 状 态 玉 “1 。 这 种 传感器 当前 
已 经 商业 化 ， 商 标 为 GelForce。 

有 一 些 已 研制 出 来 的 传感器 采用 监测 从 皮肤 表面 
反射 的 或 者 是 由 于 表面 下 空洞 的 声学 扭曲 而 产生 的 声 
能 变化 。Shinode 等 “给 出 的 一 种 传感器 是 检测 从 
靠近 皮肤 表面 的 声 谐振 腔 所 反射 的 声 能 量 的 改变 ， 它 


图 19.6 总 结 了 前 面 所 评述 的 各 种 类 型 传感器 所 
获得 的 信息 的 一 般 流程 ， 由 原始 的 感 测量 到 提供 给 操 
作 、 探 测 和 响应 的 信息 。 一 种 有 用 的 思考 就 是 考虑 究 
竞 哪 些 信息 我 们 用 来 执行 一 项 任务 ,例如 在 手指 间 来 
回转 动 钢笔 。 即 使 我 们 闭 上 了 眼睛 也 很 容易 完成 这 个 任 
务 。 我 们 使 用 了 哪些 信息 ? 我 们 需要 跟踪 笔 的 位 置 和 
方向 ， 监 测 我 们 施加 于 钢笔 上 的 力 以 保持 稳定 的 操 
作 。 换 句 话 说 ,我 们 需要 知道 我 们 所 抓 取 的 结构 外 
形 ， 在 我 们 手指 表面 上 接触 的 位 置 和 运动 ， 抓 取 力 的 
大 小 ， 考 虑 摩擦 力 限制 的 接触 条 件 等 。 对 于 机 器 人 也 
要 有 同样 的 需求 ， 可 以 通过 图 19.6 中 信息 流程 来 
提供 。 


驱动 力 


几何 形状 


` 
3 
' 
~ 
` 


接触 形状 $. 
| 表面 应 力 


接触 脉冲 振动 


表面 特性 
(例如 热 特性 ) 


图 19. 6 力 和 触觉 传感器 信息 流程 和 信号 处 理 


物体 位 姿 估计 
J) Ea 


| 


特征 提取 E X 
d 物体 形状 
物体 辨别 


面相 对 指 尖 很 小 时 ， 以 至 于 可 以 近似 为 点 
尖 为 凸 面 形状 ， 就 容易 计算 出 来 接触 位 


Af, 用 如 图 19.2 所 示 类 型 的 力 / 力 多 


指 尖 表 


在 图 19. 6 的 左上 角 ， 关 节 角 度 结合 机 械 手 的 正 当 接 触 
向 运动 学 模型 与 所 知 的 外 部 连 杆 几何 尺寸 ， 建 立 固 连 。 ”接触 ， 结 合 指 
于 指 尖 的 位 置 和 方位 的 坐标 系 。 这 个 信息 需要 整合 关 H. 19.7 描绘 了 与 
于 物体 形状 、 表 面 法 向 方位 等 的 局 部 信息 ， 以 便 能 确 
定 物体 整体 的 几何 形状 和 姿态 。 对 于 坐标 系 原点 的 力 甸 
驱动 力 传感器 提供 关于 合力 的 信息 ， 使 用 了 雅 可 
eae Me. f= Tr， 其 中 了 是 一 个 nx1 的 向 量 ，  hefxtjén KH. 
表示 相对 固 连 于 工具 附件 的 坐标 系 的 外 部 力 和 力矩 ; aÑ 
路 是 雅 可 比 转 置 和 矩阵， 映射 外 部 作用 力 和 力矩 到 关节 
B. T 是 一 个 m x1 的 向 量 MAA m^ E BUE 一 个 对 应 于 正 (内 向 ) 


E 


f— Fl ies zu BERT HEAR. defi] BE 六 的 第 大 列 的 元 素 
都 远 远大 于 J 的 整体 条 件数 ， 从 而 为 了 的 第 个 元 素 


提供 准确 的 测量 。Eberman 和 Salisbury 9 5: 认为 如 果 


机 械 手 具有 明晰 的 动力 学 方程 ， 是 有 可 能 仅仅 使 用 对 


关节 转 矩 的 测量 来 实现 对 接触 力 及 其 位 置 的 测量 。 


或 者 ， 我 们 可 以 使 用 安装 在 手指 上 ， 见 图 19. 3， 


或 者 在 机 器 人 腕 关节 处 的 多 维 力 / 力 久 


E 传 感 器 来 获得 


接触 力 。 这 种 方法 的 优势 在 于 可 以 提供 具有 很 高 信 噪 
比 的 动态 力 信号 ， 因 为 它们 不 会 被 机 器 人 手臂 或 手指 


以 及 它们 的 传动 装置 的 惯性 所 掩盖 。 如 果 指 尖 的 几何 
形状 已 知 ， 可 以 使 用 本 征 


i J 


pul 


9. 50,94] 方法 通 


检测 作用 在 传感器 上 合力 和 力矩 的 比值 来 计算 接触 位 
置 和 接触 力 。 


ET =r xf。 如 果 我 们 考虑 垂直 
于 了 作用 力 线 的 杠杆 臂 h， 则 h/h 2f/fx t/t, Kp 
于 是 可 以 得 到 r= 有 hh -af， 其 中 
曾 过 求解 作用 力 线 与 指 尖 表面 的 交点 得 到 的 常 


量 。 对 于 凸 状 指 尖 ， 将 有 两 个 这 样 的 交点 ， 其 中 只 
的 接触 力 。 


图 19.7 本 征 触觉 感 测 : 接触 会 产生 一 条 唯一 的 
作用 线 和 相对 指 尖 坐标 系 原点 的 力矩 (通过 求解 
作用 线 与 指 尖 表面 的 交点 可 以 得 到 接触 位 置 ) 


看 接触 在 位 置 > 的 接触 
E 传 感 器 测量 相 
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更 进一步 ， 从 接触 位 置 可 以 推断 出 局 部 接触 法 
向 ， 并 且 通 过 少量 力 的 测量 推断 出 接触 运动 的 类 型 。 
Bicchi 提出 一 种 算法 将 这 些 方法 扩展 应 用 于 柔软 手 
15:99. Brock 和 Chiu 5 描述 了 采用 这 种 方法 ， 利 
用 力 传感器 来 感知 物体 的 形状 以 及 测量 被 抓 物 体 的 质 
量 和 重心 。 

对 于 涉及 很 小 的 物体 或 很 小 的 力 和 动作 的 精细 作 
业 ， 皮 肤 传感器 可 以 提供 非常 灵敏 的 测量 。 一 般 而 
言 ， 随 着 作业 要 求 变 得 越 来 越 小 ， 传 感 器 必须 更 加 靠 
近 接 触 部 分 ， 以 使 介 于 中 间 的 机 械 手 零件 的 柔顺 性 和 
惯性 不 干扰 测量 。Dario'* ”指出 指 尖 力 传感器 可 以 
测量 0.1 ~ 10.0N 的 力 ， 而 阵列 传感器 可 以 测量 
0.01 ~1.0N 的 分 布 力 。Son 4 U9 1 发 现 本 征 触觉 感 
测 和 阵列 传感器 都 可 以 提供 精确 的 (1lmm 以 内 ) Be 
触 位 置 确 定 ， 但 是 本 征 触觉 感 测 方法 对 力 / 力 和 矩 传 感 
器 标定 精度 具有 固有 的 敏感 性 ， 并 且 未 建 模 的 动态 力 
也 会 产生 瞬时 误差 。 

沿 着 图 19. 6 的 左 侧 继续 向 下 ， 是 皮肤 阵列 传 感 
器 这 一 大 类 。 对 来 自 阵 列传 感 器 的 信息 解释 首先 取决 
于 换 能 器 的 类 型 。 对 于 二 值 接触 或 接近 觉 传感器 阵列 
来 说 ， 解 释 主 要 就 是 确定 接触 面 的 位 置 和 形状 。 二 值 
视觉 的 通用 技术 可 以 用 于 获得 亚 像 素 分 辨 率 ， 从 而 识 
别 接触 特征 。 这 个 信息 ， 与 通过 驱动 力 或 力 / 力 矩 传 
感 器 所 测量 的 抓 取 力 相 结合 ， 对 于 基本 的 操作 作业 已 
经 足够 了 1。 


19.2.2 固体 力学 与 反 卷 积 


有 一 个 与 触觉 阵列 传感器 相关 的 基本 问题 ， 就 是 
通过 一 组 从 皮肤 表面 下 所 获取 的 有 限 数量 的 测量 来 重 
构 皮 肤 表 面 所 发 生 的 情况 。 我 们 通常 感 兴趣 的 是 确定 
与 皮肤 接触 有 关 的 压力 ,或 者 是 切 应 力 的 分 布 。 在 其 
他 情况 下 ， 比 如 当 指 尖 由 凝 胶 或 被 一 层 注 膜 覆盖 的 柔 
性 泡 棉 组 成 ， 以 至 于 压力 几乎 恒定 不 变 时 ， 所 关注 的 
则 是 接触 的 局 部 几何 形状 。 

在 下 面 的 例子 里 ， 我 们 考虑 阵列 元 件 位 于 弹性 皮 
肤 表面 下 方 深度 为 d 的 情况 。 接 触 导致 了 在 关注 区 域 
上 的 压力 分 布 。 我 们 建立 一 个 其 z 轴 指 向 向 内 法 线 方 
向 的 坐标 系 ， 为 简单 起 见 ， 我 们 考虑 一 维 受 力 状况 ，p 
(y)， 其 压力 分 布 沿 x 方向 是 不 变 的 。 我 们 进一步 假设 
皮肤 在 x 方向 上 的 长 度 远大 于 皮肤 的 厚度 ， 所 以 x 方 
向 的 应 变 是 受 抑 制 的 ， 就 可 以 看 作 平 面 应 变 弹 性 力学 
问题 。 我 们 还 假设 皮肤 是 一 个 均 质 、 各 向 同性 的 材料 
并 且 应 变 小 到 足以 满足 线性 弹性 理论 应 用 的 条 件 。 当 
然 ， 在 现实 情况 下 没有 一 种 假设 是 完全 符合 的 ; 但 
是 ， 结 果 与 从 实际 机 器 人 手指 和 触觉 阵列 获得 的 测量 


是 定性 一 致 的 。 对 于 一 般 方 法 和 线性 弹性 模型 精度 的 
详尽 讨论 可 参见 参考 文献 [19. 22, 79, 96 ~98] 。 

图 19. 8 说 明了 两 个 线性 负荷 或 刀刃 挤 压 皮肤 表 
面 的 情况 (类似 于 人 类 触觉 敏锐 度 的 两 点 辨别 测试 
中 的 平面 类 型 ) 。 对 单个 线性 负荷 和 脉冲 响应 的 求解 
在 1885 年 由 Boussinesq 得 出 。 对 于 平面 应 变 情 况 ， 
在 笛 卡 儿 坐 标 系 下 单位 法 向 脉冲 在 (y,，z) 平面 的 主 
应 力 可 以 表示 为 ”| 


o 传感器 ,四 = 24 
m {BRE d = 34 


3.334 6.66 A 


一 一 连续 应 力 


0 1 2 3 4 5 6 7 8 9 10 
yh (A) 
图 19. 8 两 个 线 负荷 (单位 量 ) 的 平面 -应 变 应 力 响 应 
(注意 在 较 大 深度 处 出 现 模糊 情况 ) 


一 2 1 
eG» = ( Em lum (19.1) 
-2Y (wx) 
e,G,2-( m lm um (19.2) 
c, (y,z) =v(0, +0,) (19.3) 


AF, v 为 材料 的 泊 松 比 (弹性 橡胶 材料 一 般 为 
0.5), 

对 于 距离 原点 分 别 为 8 和 8, 的 两 个 线性 负荷 ， 
可 以 通过 县 加 求解 得 到 


1 


—— 


OI 


(19.4) 


an 
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z z 


(19.5) 
对 于 更 一 般 的 压力 分 布 ， 应 力 可 以 通过 压力 分 布 p 
Cy) 和 脉冲 响应 G;(y,，z) 的 卷 积 得 到 

e, = | pVDATG(y -Ts) (19.6) 

图 19. 8 中 也 绘制 了 垂直 应 力 分 量 o EVA AS IR] DRE 
所 对 应 的 曲线 ，d 22A 和 d, =3A, 其 中 为 传感器 
的 间距 。 往 皮肤 下 面 越 深 应 力 就 变 得 越 平滑 或 模 
W, 并 且 区 别 两 个 近邻 脉冲 的 能 力 变 小 。 但 是 ， 这 种 
对 于 集中 压力 分 布 造成 的 模糊 也 有 一 个 好 处 ， 当 我 们 
只 有 有 限 数量 的 传感器 时 ， 因 为 应 力 和 应 变 遍 及 更 大 
的 区 域 ， 于 是 有 更 大 可 能 对 至 少 一 个 传感器 产生 作 
用 。 弹 性 皮肤 还 提供 了 一 种 自动 边缘 增强 的 功能 ， 因 
为 在 皮肤 上 负载 作用 和 未 作用 区 域 之 间 的 过 渡 处 的 应 
力 很 高 。 

在 大 多 数 情况 下 ， 例 如 ， 就 电容 式 或 电磁 式 传 感 
器 来 说 ， 敏 感 元 件 将 测量 皮肤 材料 在 垂直 方向 上 的 应 
变 或 局 部 变形 。 在 少数 情况 下 ， 比 如 压 电 薄 膜 片 朋 入 
到 弹性 皮肤 里 站 ， 传 感 器 和 周围 材料 比 起 来 足够 
坚硬 ， 所 以 它们 可 以 被 认为 是 直接 测量 应 力 。 

对 于 弹性 平面 应 变 的 情况 ， 应 变 与 应 力 有 这 样 的 
KAI 100] 


[c, -v(o, +0.) ] (19. 7) 


Lo, -v(o, +0,) ] (19. 8) 


式 中 , 是 杨 氏 模 量 ; v 是 泊 松 比 ， 对 于 弹性 橡胶 皮 
肤 我 们 假定 它 为 0. 5。 

图 19.9 展示 了 一 个 由 一 行 敏感 元 件 获 取 的 典型 
测量 结果 ， 是 对 图 19. 8 中 两 个 线性 负荷 作用 的 测量 。 
每 一 个 竖 条 表示 对 应 的 应 变 e,， 它 由 相应 的 敏感 元 
件 测量 并 利用 式 (19.8) 计算 ， 其 中 的 应 力 由 式 
(19.4)、 式 (19.5) 和 式 (19.3) 得 到 。 

在 这 一 点 上 的 问题 是 ， 利 用 有 限 数量 的 表面 下 应 
变 测量 值 ， 对 表面 压力 分 布 p(y) 做 出 最 佳 估 计 。 这 
个 问题 是 关于 从 稀少 的 遥测 数据 来 估计 信和 号 的 一 个 经 
典 例子 。 实 现 这 个 过 程 的 一 种 方法 是 基于 反 卷 积 技 
术 * 331 。 将 从 传感器 测 得 的 信号 s. 与 脉冲 应 变 响 
应 H(y) 的 逆 进 行 卷 积 来 求 得 导致 信号 产生 的 表面 压 
力 。 这 种 逆 运 算 常 常会 放大 高 频 噪 声 ， 并 且 必 须根 据 
传感器 的 空间 密度 及 其 在 表面 下 的 深度 对 逆 滤 波 器 的 
带宽 加 以 限制 。 


0 2 4 6 8 10 
REEL) 


图 19.9 假定 5% 噪声 情况 下 测量 的 应 变 


Fa PTT KO 99 是 假定 表面 压力 分 布 可 以 由 
一 组 有 限 的 脉冲 p= (pi, prp, 近似 。 传 感 吉 的 读 
数 构成 一 个 矢量 es= ( 8, even), APIF EMY 
论 的 带宽 限制 取 普 >m。 于 是 应 变 响应 可 以 被 写成 一 
个 和 矩阵 方程 


£= Hp (19.9) 
五 中 的 每 个 元 素 可 以 使 用 式 (19.8) 计算 得 到 ， 用 
BIN o Ao, HEX (19.4) 和 式 (19.5) 类 似 的 等 
式 计算 得 到 ,0o, 由 式 (19.3) 得 到 。 于 是 估计 的 离 
散 压 力 分 布 可 以 通过 五 的 伪 逆 得 到 
p=H'*e (19. 10) 
利用 图 19.9 中 在 深度 d =2A 处 的 应 变 测量 值 ， 使 用 伪 道 
方法 估计 的 压力 分 布 如 图 19. 10 所 示 。 在 这 个 例子 中 ， 
尽管 有 假定 的 5% 的 噪声 ， 因 为 这 组 假定 的 七 个 脉冲 偶 
然 地 与 实际 负荷 相 匹配 ， 重 构 仍 是 非常 精确 的 。 


fira pz). z-24 


0 1 2 3 4 5 6 7 8 9 10 
yh) 
图 19. 10 对 11 个 传感器 和 7 个 给 定 脉冲 ， 
利用 伪 道 法 估计 的 表面 压力 分 布 
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构造 柔软 机 器 人 指 尖 的 一 种 可 供 选 择 的 方法 是 包 


类 。 物 体 识别 的 目标 就 是 使 用 由 触觉 得 到 的 信息 把 


大 上 柔顺 的 中 间 物 ， 比 如 海绵 橡胶 或 装 在 薄 弹 性 膜 里 
fgg pie o mmm ono 一些 为 这 类 手指 开发 的 触觉 
阵列 传 感 顺 可 以 直接 测量 薄膜 形状 ， 所 以 不 需要 物理 
模型 用 于 信号 的 解释 '*"。 另 一 个 感 测 方案 使 用 位 
于 手指 中 间 的 磁性 传感器 阵列 ， 测 量 磁场 中 由 于 磁性 
负载 薄膜 的 变形 而 引起 的 改变 所 。 已 经 开发 出 的 
一 种 统计 算法 由 传感器 信号 可 以 鲁 棒 地 确定 薄膜 形 
状 "*"。 然 而 ,仍然 需要 一 个 力学 模型 ， 才 能 由 所 
有 这 些 传感器 提供 的 形状 信息 来 得 到 接触 面 上 的 压力 
分 布 。 


19.2.3 曲率 和 形状 信息 


测量 表面 下 应 变 或 挠 度 的 另 一 个 选择 就 是 在 传 感 
器 阵列 的 每 一 个 元 件 处 直接 的 测量 局 部 曲率 .9 09097 。 
由 率 信息 可 以 直接 应 用 于 识别 接触 类 型 和 形 心 位 置 ， 
或 它 被 整合 在 一 起 以 获得 接触 的 局 部 形状 ， 正 如 利用 
刚刚 描述 的 传感器 来 测量 薄膜 的 轮廓 。 为 了 减少 噪声 
的 影响 ， 有 必要 在 整合 之 前 为 薄膜 假设 一 个 简单 的 模 
型 并 使 用 基 函 数 来 拟 合 曲率 数据 天 2 。 

回 到 图 19.6， 一 旦 局 部 接触 形式 或 几何 形状 建 
立 起 来 ,下 一 步 往往 是 特征 识别 (例如 ,识别 物体 
EMSA EASTER) 以 及 确定 手中 物体 的 整体 形状 和 
姿态 。 

通常 物体 的 形状 是 至 少 部 分 地 先 验 已 知 ， 在 这 种 
情况 下 有 多 种 表面 或 数据 拟 合 方法 可 以 使 用 ， 例 如 ， 
Fearing' "开发 了 一 种 由 触觉 阵列 数据 来 计算 曲率 
半径 和 广义 圆柱 方位 的 方法 ， 还 开发 了 进行 类 似 的 计 
FARRAR  。 其 他 的 方案 使 用 接触 位 置 、 表 
面 法 向 和 接触 力 来 确定 关于 物体 形状 和 相对 于 手 的 方 
fey Ae ON) 

Allen! 基于 用 于 感 测 物体 的 特殊 探测 过 程 ， 
对 物体 形状 属性 使 用 了 几 种 不 同 的 基 元 表示 法 。 物 体 
的 体积 和 近似 形状 通过 围绕 抓 取 来 感知 ， 并 且 利用 超 
二 次 曲面 对 最 终 得 到 的 形状 建 模 。 同 样 ， 依 据 一 种 广 
义 圆 柱 表示 法 ,测量 物体 表面 的 侧面 大 小 可 以 得 到 一 
个 “ 面 一 边 一 顶点 ”模型 和 轮廓 。 

关于 由 什么 构成 一 个 恰当 的 特征 集合 的 问题 还 不 
是 很 清楚 ， 尽 管 它 明显 地 取决 于 预期 的 应 用 。 了 EL- 
lis ^ 9 考虑 了 恰当 的 特征 集合 以 及 用 于 获得 所 需 数 
据 的 方法 。Lederman 和 Browse! 7 !*! 指出 表面 粗糙 
度 、 表 面 曲率 和 定位 边 都 在 人 类 触觉 感知 中 所 使 用 。 


物体 和 表面 识别 
触觉 信息 最 常见 的 应 用 是 关于 物体 的 识别 和 分 


二 
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个 物体 从 一 组 已 知 的 物体 中 辨别 出 来 。 分 类 的 目 
标 则 是 按照 预选 的 感知 的 属性 把 对 象 分 类 。 这 些 系统 
通常 是 基于 由 触觉 阵列 或 力 传感器 获得 的 几何 信息 。 
最 近 ， 在 探测 和 识别 任务 中 使 用 其 他 类 型 的 触觉 信息 
(比如 柔顺 性 、 纹 理 、 热 特性 ) 也 受到 了 一 些 
关注 

许多 系统 采用 了 统计 模式 识别 方法 ， 由 于 只 有 来 
自 感 测 数 据 的 统计 信息 被 使 用 ， 这 个 方法 可 以 提高 抗 
干扰 性 。 遗 憾 的 是 ， 这 也 就 意味 着 只 有 少数 物体 类 型 
可 以 被 辨别 。 已 开发 的 系统 有 基于 触觉 阵列 传感器 数 
Ji n Be fei, SP) 和 基于 抓 取 物 体 时 的 手指 关节 
角度 的 统计 信息 的 0 。 

许多 从 触觉 阵列 数据 提取 的 不 同 特征 已 经 用 于 基 
于 模型 的 识别 和 分 类 。 系 统 使 用 了 几何 特征 ， 比 如 
fL. YU Re fg io meo 以 及 物体 表面 " ”2 。 其 他 
特征 集合 包括 几何 矩 8) HEPEAR AUS UT 和 表 
iR JE Fr 3n] 9 128] o Gaston 和 Lozano- Perez! ^ 11°! 使 用 
局 部 表面 法 向 和 接触 位 置 作 为 特征 ， 它 们 可 以 从 阵 
列 、 力 或 关节 传感器 信息 获得 。Siegell ^ 7! 提出 一 种 
通过 测量 手指 关节 角度 和 扭矩 ， 得 到 机 器 人 手中 所 抓 
取 已 知 物体 的 姿态 的 方法 。 


19.2.5 主动 感 测 策略 


由 于 接触 仅仅 提供 局 部 的 信息 ， 因 此 运动 是 进行 
识别 和 探测 的 触 党 感 测 中 必 不 可 少 的 一 个 部 分 。 有 几 
个 关于 物体 识别 应 用 方面 的 研究 者 开发 出 了 传感器 运 
动 的 规划 策略 ， 以 便 在 每 一 次 后 续 观 测 中 减少 与 先前 
观测 中 结果 一 致 的 目标 的 数量 。 这 有 时 也 被 称 为 
“假设 与 测试 ”方法 。 早 期 的 例子 包括 Curfinkel 
等 8451 和 Hillis!!! Schneiter'* 50 、Grimson 和 
Lozano- Perez? !9! " Ellis? °°! 和 Cameron 7 PU 都 
开发 出 了 用 于 规划 传感器 运动 的 算法 ， 通 过 对 接触 位 
置 和 局 部 表面 法 向 的 接触 测量 来 快速 识别 多 边 形 物 
体 。 在 Schneiter 的 方案 中 ,每 次 感 测 运动 必须 穿 过 
所 有 与 前 一 次 传感器 观测 一 致 的 目标 的 交会 边界 。 
Yap 和 Cole 指出， 一 个 用 于 确定 具有 了 个 顶点 
的 凸 平面 多 边 形 形 状 的 探测 策略 ， 至 少 需要 3V-1 次 
测量 。Roberts P? 提出 了 一 个 用 于 识别 的 运动 策略 ， 
采用 沿 着 物体 表面 和 边缘 跟踪 机 器 手指 ， 而 不 是 移动 
手指 穿 过 它们 之 间 的 自由 空间 。 

在 非 基 于 模型 的 方法 中 ，Klatzky 等 9 1 提出 
机 器 人 系统 可 以 采用 与 人 类 在 触觉 探测 中 所 使 用 的 
相同 的 探测 程序 。 这 些 程序 规定 了 任务 所 需要 的 手 
指 运动 ， 比 如 描摹 物体 轮廓 、 测 量 柔 顺 性 和 确定 物 


= 


20 第 3 篇 


传 感 与 感知 


体 表 面 的 侧面 大 小 。 Stansfield 9 19:532 和 Affen 9 13! 
使 用 带 有 触觉 阵列 传感器 的 多 指 机 器 人 手 执行 过 一 
些 这 样 的 探测 程序 。Dario 等 OH t iit T WMA 
触觉 子 程序 ， 并 已 用 于 一 些 令 人 关注 的 应 用 中 , 包 
括 对 柔软 表面 下 硬化 肿块 (比如 肿瘤 ) 的 探测 。 
Kaneko 和 Tanie? 5 描述 了 一 种 方法 使 用 很 小 的 手 
指 运动 来 找到 手指 一 物体 接触 的 位 置 ， 而 不 需要 分 
布 式 的 触觉 传感器 。 

边缘 跟踪 和 表面 跟随 也 得 到 很 大 的 关注 。Muth- 
ukrishnan 4& ^ P5! 研究 了 边缘 发 现 算法 用 于 连续 的 触 
觉 阵列 感知 之 间 的 段 匹配 。Berger 和 Khosla! °°! fe 
示 了 利用 触觉 阵列 信息 实现 的 实时 弯曲 边缘 跟踪 。 
Pribadi 等 (* 7 提出 了 一 种 使 用 触觉 信息 跟踪 未 知 物 
体 表 面 的 控制 策略 。Bay'”*'* 设 计 了 一 种 表面 形状 
估计 器 用 于 利用 多 指 手 的 探测 ， 它 使 用 来 自 一 个 力 
传感器 的 接触 位 置 及 表面 法 向 信息 。Zhang 和 
Chen? ”3 提出 了 一 种 触觉 个 服 的 方法 ， 他 们 对 柔顺 
触觉 传感器 和 物体 之 间 的 接触 进行 建 模 从 而 获得 触 
觉 雅 克 比 矩阵 ， 并 将 其 用 于 生成 机 械 手 增 量 运动 指 
令 。 他 们 验证 了 这 种 方法 在 深 动 接触 和 边缘 跟踪 任 
务 中 的 应 用 。 


的 动态 触觉 传感器 ， 一 起 用 于 在 不 同 物体 中 进行 辩 
别 。 受 人 类 所 使 用 步骤 启发 得 到 的 不 同 探测 步 
EROS, qim EH RUE C. 


19.3 集成 的 需求 


我 们 还 没有 讨论 的 一 个 关键 问题 是 连接 一 个 大 型 
的 各 式 各 样 的 触觉 传感器 阵列 的 困难 。 在 1987 年 Ja- 
cobsen 等 3] 就 指出 布线 可 能 是 灵巧 手 设计 中 最 大 
的 难题 ， 并 且 在 很 大 程度 上 , 今天 依然 是 这 样 的 。 但 
是 ， 近 年 来 针对 这 个 问题 已 经 提出 了 一 些 解决 办 法 ， 
使 用 无 线 传 感 器 或 者 使 用 智能 总 线 用 于 电源 与 信号 的 
连接 。Shinoda 和 asa!!! Ze di E Hz RC HUC ACT (UR 
无 线 传 感 元 件 ， 使 用 一 个 感应 基础 线圈 来 供电 和 发 送 
信号 。 每 一 个 传 感 元 件 就 是 一 个 具有 不 同 谐振 频率 的 
调谐 谐振 器 ， 其 谐振 频率 是 对 应 力 敏 感 的 。Yamada 
等 ”使 用 无 线 传感器 芯片 ， 这 个 芯片 使 用 穿 过 
个 透明 弹性 体 的 光 传 输 用 于 供电 和 传送 六 个 应 力 分 
量 到 安全 地 置 于 皮肤 表面 下 的 能 量 接收 芯片 。Ha- 
kozaki 和 Shinoda ^ 5! 7E p JE Sj ry fg s zz DR] BA. fi s 
传 感 蕊 片 ， 导 电 橡 胺 用 作 供 电 和 串口 通信 总 线 从 而 


实际 上 ,表面 跟随 和 操作 经 常 是 结合 在 一 起 
的 。Okamura 和 Cutkosky ^ 1401 提出 了 一 种 方法 使 
用 具有 和 触觉 传感器 的 圆 形 指 尖 来 跟踪 物体 表面 巴 
定位 特征 ， 特 征 定义 为 其 局 部 曲率 高 于 指 尖 曲率 
的 那些 区 域 。 


19.2.6 动态 感 测 和 事件 检测 


对 于 用 来 检测 诸如 指 尖 和 物体 间 轻 柔 接触 或 
滑动 事件 的 动态 触觉 传感器 来 说 ， 最 主要 的 挑战 
就 是 在 于 能 否 可 靠 地 检测 事件 ， 并 且 没 有 误 报 。 
响应 触觉 事件 而 产生 很 大 信和 号 的 动态 触觉 传感器 ， 
也 很 容易 响应 机 器 人 传动 机 构 的 振动 和 机 咒 人 手 
爪 快 速 地 加 速 而 产生 很 大 的 信号 。 为 了 更 鲁 棒 地 
检测 触觉 事件 ， 解 决 方法 包括 比较 来 自 接触 区 域 
上 和 远离 接触 区 域 的 动态 触觉 传感器 所 测量 的 信 
号 ， 以 及 鉴别 真正 触觉 事件 的 “特征 ”的 统计 模 
式 识别 方法 号 


热 觉 传感器 和 其 他 传感器 的 集成 


像 热 接触 传感器 的 这 类 传感器 很 少 单独 使 用 。 它 
们 的 信号 通常 与 来 自 触觉 阵列 和 其 他 传感器 的 信和 号 整 
合 在 一 起 ， 以 产生 额外 信号 用 于 识别 物体 。Dario 
等 "展示 了 一 种 方法 ， 一 个 热 接触 传感器 结合 一 
个 触觉 压力 感 测 阵列 ， 以 及 一 个 用 于 刻画 表面 粗糙 度 
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消除 单独 的 线路 。 微 处 理 器 尺寸 的 缩小 也 使 得 在 最 
接近 传感器 的 地 方 安放 多 路 复 用 、 信 号 调节 等 装置 
成 为 可 能 ， 从 而 减少 了 必须 转发 回 机 器 人 的 原始 信 
息 的 数量 。 


19.4 总 结 和 展望 
和 计算 机 视觉 比 起 来 ， 触 觉 感 测 总 是 看 起 来 还 
要 若干 年 才能 被 广泛 采用 。 正 如 在 本 章 的 引言 中 所 
介绍 ， 原 因 包 括 物理 问题 (传感器 的 放置 和 和 鲁 棒 
性 ， 连 线 的 困难 ) 和 传感器 类 型 的 多 样 性 ， 比 如 用 
于 检测 力 、 压 力 、 局 部 几何 形状 、 震 动 等 。 正 如 我 
们 所 看 到 的 ， 这 些 触 觉 信息 量 中 每 种 的 变换 和 解释 
方法 都 有 很 大 不 同 。 但 是 ， 仍 有 一 些 基 本 的 问题 是 
触觉 感 测 所 共同 面临 的 。 例 如 ， 传 感 融 普遍 置 于 柔 
性 皮肤 里 面 或 皮肤 下 方 ， 与 作用 于 皮肤 表面 上 的 压 
力 、 应 力 、 热 梯度 或 移 位 相 比 ， 它 们 检测 得 到 的 量 
将 受到 影响 。 

当 为 机 器 人 臂 或 手 选择 触觉 传感器 时 ， 首 先 考虑 
最 想得到 哪 种 触觉 量 以 及 用 于 什么 目的 是 行 之 有 效 
的 。 例 如 ， 在 力 伺 服 中 主要 关心 的 是 以 足够 的 数据 率 
获得 负荷 或 接触 力 的 准确 测量 值 ， 这 样本 征 触觉 感 测 
可 能 是 最 合理 的 。 如 果 以 滑动 或 滚动 方式 的 轻柔 接触 
来 操作 物体 ， 测 量 压 力 分 布 或 者 局 部 皮肤 变形 的 弯曲 
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阵列 传感器 将 是 最 需要 的 。 如 果 探 测 物体 来 了 解 它们 
的 纹理 或 材料 成 分 ， 动 态 触觉 传 感 器 和 热 觉 传感器 将 
更 为 有 效 。 

在 理想 世界 里 ， 可 以 把 所 有 这 些 触觉 传 感 器 加 入 
到 机 融 人 的 末端 执行 器 中 ， 而 不 用 考虑 成 本 、 信 和 号 处 
理 或 布线 复杂 性 。 幸 运 的 是 ， 适 于 触觉 感 测 的 变换 器 


的 成 本 和 尺 二 都 在 不 断 地 下 降 ， 并 且 和 柔性 电路 表面 封 
装 器 件 的 利用 ， 使 得 执行 本 地 化 信息 处 理 的 能 力也 在 
提高 。 在 不 和 久 的 将 来 ， 使 用 材料 沉积 和 激光 加 工 技 
术 ， 在 型 面 上 现场 制作 密集 的 变换 器 阵列 将 逐渐 成 为 
可 能 。 这 样 ， 使 机 器 人 最 终 开 始 具有 近似 于 最 低 等 动 
物 的 触觉 灵敏 度 和 响应 能 力 。 
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本 章 检 视 了 如 何 利用 这 个 世界 的 一 些 固有 属 
性 ， 来 为 一 个 机 器 人 或 者 其 他 类 似 装置 ， 开 发 一 种 
关于 它 相 对 于 一 个 外 部 参照 系 的 运动 或 者 姿态 
(位 置 和 方向 ) 的 模型 。 尽 管 对 众多 自动 机 器 人 系 
统 来 说 ， 建 立 并 维持 对 一 个 移动 机 器 人 姿态 的 预测 
都 是 一 个 重要 的 问题 ， 但 是 ， 这 个 问题 已 在 地 球 导 
航 史 中 存在 很 长 时 间 了 。 
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20.1 里 程 仪 


里 程 仪 odometry 是 希腊 文字 hodos ( 意 为 旅行 或 
旅程 ) 和 metron ( 意 为 测量 ) 的 缩写 。 鉴 于 它 在 一 
系列 从 土木 工程 到 军事 占领 的 广泛 应 用 ， 有 关 里 程 
仪 的 基本 概念 的 研究 已 经 进行 了 两 千 多 年 。 关 于 里 
程 仪 最 早期 的 记述 有 可 能 是 Vitruvius 所 著 的 建筑 十 
书 。 在 书 中 ， 他 这 样 描述 到 “有 这 样 一 种 从 我 们 的 
祖先 传 下 来 的 极其 有 用 的 ， 凝聚 了 最 伟大 的 灵性 的 
发 明 。 它 使 得 我 们 在 驾驶 着 马车 来 往 于 大 道上 时 或 
者 乘坐 着 帆船 航行 于 海洋 上 时 ， 可 以 知道 我 们 已 经 
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非常 广泛 。 


具体 使 用 里 程 仪 来 预测 交通 工具 的 方位 随 其 设计 
的 不 同 而 相 异 。 对 使 用 里 程 仪 预测 方位 的 陆地 移动 机 
器 人 来 说 ， 最 简单 的 可 能 是 差 动 驱 动车 ( 见 图 
20. 1) 。 一 部 使 用 差 动机 构 来 驱动 的 车 辆 拥有 两 个 装 
在 同一 车 轴 的 可 独立 控制 的 驱动 轮 。 假 定 两 个 驱动 轮 
相对 于 车 身 的 安装 位 置 固 定 ， 为 保证 两 个 轮子 始终 保 
持 与 地 面 的 接触 ， 这 两 个 轮子 必须 在 地 面 上 做 弧 形 运 
动 以 使 整个 车 身 能 以 驱动 轴 上 的 一 点 为 中 心 旋转 。 此 
点 也 就 是 ICC， 即 瞬时 曲率 中 心 ( 见 图 20.1)。 假设 
左右 两 个 驱动 轮 相对 于 地 面 的 速度 分 别 为 和 vw,， 并 
目 两 个 轮子 相距 24， 那 么 有 


完成 了 多 少 里 的 行程 "所 2 。 在 自动 交通 工具 的 范畴 
里 ， 里 程 仪 通常 是 指 利 用 来 自 交 通 工具 的 制动器 
(如 轮子 ， 踏 板 等 ) 的 数据 来 预测 它 的 整体 运动 。 这 
其 中 的 基本 概念 是 针对 交通 工具 的 制动器 ， 如 轮子 和 
关节 ， 锐 链 等 的 特定 运动 ， 开 发 一 种 数学 模型 ， 以 推 
导出 交通 工具 自身 的 运动 ， 并 且 对 这 些 特定 运动 进行 
时 域 的 积分 以 开发 出 一 个 交通 工具 自身 的 姿态 关于 时 
间 变 量 的 函数 模型 。 这 种 利用 里 程 仪 的 信息 ， 以 时 间 
为 变量 来 预 估 交通 工具 姿态 函数 的 方法 通常 被 称 为 航 
位 推测 法 或 者 演绎 推测 法 。 这 种 方法 在 航海 中 的 应 用 


w(R+d) =», 

w(R-d) =», 
HP, o 是 车 身 围绕 ICC 旋转 的 角速度 ; R 则 是 车 身 
中 心 到 ICC 的 距离 。 我 们 重新 安排 上 面 这 两 个 公式 可 
以 求解 w FIR, B 


(8 =i) 
e= (2d) 

E (n+) 
s (v, 7v) 


并 且 ， 两 个 驱动 轮 之 间 中 点 的 线 速 度 耻 = wR。 
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图 20.1 差 动机 构 的 运动 学 模型 


既然 和 vw 是 时 间 的 函数 ， 我 们 可 以 获得 一 系列 
差 动 驱动 车 的 运动 方程 。 以 驱动 轮 中 点 为 车 身 原点 ， 
设 0 为 车 映 相对 于 一 个 全 局 笛 卡 儿 坐 标 系 的 x 轴 的 方 
向 角 ， 我 们 可 以 得 到 


"OE. [V cos( ace) ) dt 


"OE [v sinoc) at 


a(t) = [a(n a 

这 就 是 差 动 机 构 车 在 平面 上 以 里 程 仪 预测 E 
态 的 方程 。 如 果 控 制 输入 量 (vov) 以 及 一 些 初 
始 预测 值 已 知 ， 我 们 就 可 以 使 用 这 个 运动 模型 求 
得 此 类 机 器 人 在 任何 时 刻 的 一 个 理想 化 的 状态 
预测 。 

因此 ， 从 原则 上 来 说 ， 借 用 此 模型 和 充分 的 控制 
输入 量 ， 我 们 一 定 能 够 用 里 程 仪 预测 任何 时 刻下 的 机 
大 人 姿态 。 在 一 个 理想 世界 里 ， 这 些 即 是 我 们 用 以 预 
测 机 器 人 在 未 来 任何 时 刻 姿态 的 所 有 必要 条 件 。 但 不 
幸 的 是 ， 在 现实 世界 里 ， 在 使 用 航 位 推测 法 得 到 的 机 
器 人 的 运动 状态 和 它 的 实际 运动 状态 总 是 存在 着 误 
差 。 导 致 这 些 误差 的 因素 很 多 ， 包 括 建 模 误 差 (UH 
轮子 尺寸 的 测量 误差 ， 车辆 本 身 尺 寸 的 测量 误差 ) ， 
控制 输入 量 的 不 确定 性 ， 马 达 控 制 占 的 实现 (如 轮 
子 的 指令 旋转 角度 和 实际 旋转 角度 ) ， 以 及 机 器 人 本 
身 的 物理 建 模 误 差 (包括 轮子 的 上 紧 状 态 ， 地 面 的 
压 实 状 态 ， 轮子 打滑 和 轮胎 面 实际 上 的 宽度 不 可 能 》 
零 等 )， 等 等 。 针 对 这 些 误差 的 解决 就 形成 了 车 辆 的 
姿态 控制 这 个 课题 。 这 个 课题 的 解决 需要 融合 航 位 推 
测 法 和 其 他 的 传感器 系统 。 

本 手册 的 其 他 章节 (如 21 ~24 章 ) 检视 了 可 以 
预测 或 者 改变 机 器 人 姿态 的 其 他 传 感 需 系统 。 这 些 传 


感 融 或 依赖 于 外 部 事件 ， 或 依赖 于 视觉 或 是 其 他 种 种 
条 件 。 本 章 我 们 将 继续 探讨 惯性 测量 装置 和 全 球 定位 
系统 。 其 中 ， 惯 性 测量 装置 是 一 种 测量 在 受 外 力 影 响 
下 的 物体 物理 属性 转换 的 传感器 。 


20.2 陀螺 仪 系统 


陀螺 仪 是 测量 交通 工具 方向 变化 的 传感器 系统 。 
此 类 系统 利用 了 物理 学 中 物体 在 旋转 时 能 够 产生 可 预 
测 效 应 的 原理 。 一 个 旋转 系 并 不 一 定 是 惯性 系 ， 因 此 
许多 物理 系统 将 会 显现 非常 明显 的 非 牛顿 状态 。 通 过 
测量 这 些 与 本 应 出 现在 牛顿 坐标 系 的 常规 状态 的 差 
异 ， 我 们 得 以 求 得 物体 潜在 的 自转 。 


20.2.1 机 械 式 系统 


机 械 式 陀螺 仪 系统 和 旋转 罗盘 系统 在 导航 史 中 
出 现 的 时 间 很 早 。 通 常 ， 有 据 可 查 的 史料 认为 
Bohnenberger 是 第 一 个 制造 陀螺 仪 的 人 中 4。 而 在 
1851 年 , Leon Foucault 是 第 一 个 证 实 陀螺 仪 作为 一 
个 惯性 系 存在 的 人 。 第 一 个 旋转 罗盘 系统 的 专利 则 
属于 Martinus Geradus ven den Bos， 那 时 是 1885 年 。 
1903 4E, Herman Anschutz- Kaempfe 则 第 一 次 制造 出 
一 个 可 以 运转 的 陀螺 仪 并 对 设计 申请 了 专利 。 在 
1908 ^E, Elemer Sperry 在 美国 申请 了 一 个 旋转 罗盘 
的 专利 并 试图 把 它 卖 给 德国 海军 。 紧 接着 一 场 专利 
战争 开始 ， 并 由 Albert Einstein 证 实 了 整个 经 过 。 
(更 多 有 关 旋 转 罗 盘 及 其 发 明 者 的 详情 请 参见 参考 
文献 【20.5-8] 。) 

陀螺 仪 和 旋转 罗盘 主要 是 依赖 于 角 动 量 守恒 原理 
THEA) 。 角 动量 是 指 在 无 外 部 力矩 作用 下 ， 一 个 
旋转 的 物体 围绕 同一 转轴 保持 不 变 的 角速度 的 趋势 。 
假设 一 个 转动 中 的 物体 的 角速度 为 oa， 而 它 的 转动 惯 
量 是 TI， 那么 它 的 角 动量 工 则 是 工 = 了 Txw。 

让 我 们 考虑 一 个 安装 在 一 个 万 向 节 上 可 以 任意 改 
变 转 轴 的 快速 转 轮 (LEE 20. 2a) 。 假 设 空气 阻尼 和 
轴承 没有 产生 任何 摩擦 阻力 ， 那 么 转子 的 转轴 将 保持 
国定 ， 而 与 万 向 节 转 子 的 运动 无 关 。 尽 管 通常 不 直接 
通过 陀螺 仪 来 使 用 角 动 量 守恒 原理 ， 这 种 转轴 保持 旋 
转 方向 固定 的 性 质 可 以 用 以 保持 一 个 安装 在 交通 工具 
上 面 的 轴承 的 转动 。 而 此 轴承 的 转动 可 以 与 此 交通 工 
具 的 运动 无 关 。 为 更 清楚 的 解释 这 一 点 ， 让 我 们 假设 
一 个 陀螺 仪 安置 在 赤道 上 ， 其 转轴 与 赤道 方向 一 致 
( 见 图 20.2b)。 当 地 球 转动 时 ， 陀 螺 仪 围绕 一 个 固定 
转轴 转动 。 在 一 个 与 地 球 同步 的 观测 者 眼中 ， 这 个 陀 
螺 仪 将 每 24h 旋转 回 到 它 起 始 的 方向 。 同 样 ， 假 设 此 
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陀螺 仪 被 放置 在 赤道 上 但 是 它 的 转轴 与 地 球 的 转轴 平 ”积分 陀螺 仪 在 陀螺 仪 内 部 使 用 嵌入 式 处 理 器 对 旋转 速 


行 ， 那么 ， 在 一 个 与 地 球 同 步 的 观测 者 看 来 ， 此 陀螺 — 率 进 行 积分 ， 从 而 计算 出 交通 工具 的 绝对 旋转 角度 。 
仪 将 在 地 球 转动 的 时 候 保 持 静 止 。 为 了 探究 如 何在 相对 于 地 球 固定 的 坐标 系 内 使 用 
中 陀螺 仪 来 进行 导航 ， 我 们 希望 陀螺 仪 的 转轴 相对 于 地 

球 坐 标 系 固定 ， 而 不 是 相对 于 一 个 外 部 坐标 系 固定 。 


旋转 罗盘 通过 旋 进 获得 这 种 相对 固定 。 当 一 个 力矩 作 
oh 用 于 一 个 旋转 的 物体 使 其 改变 旋转 方向 时 ， 旋 转动 量 
的 守恒 造成 改变 的 旋转 方向 同时 垂直 于 角 动 量 的 方向 


和 力矩 施加 的 方向 。 这 种 效应 将 造成 悬 置 于 某 一 端的 

E 陀螺 仪 围绕 着 其 悬 置 的 那 一 端 旋转 。 让 我 们 来 看 图 

5 20. 3a 所 示 的 钟 摆 式 陀螺 仪 ， 这 是 一 个 在 旋转 轴 的 下 

— E 端 配 重 的 标准 陀螺 仪 。 如 前 所 述 ， 想 象 此 钟 摆 式 旋转 

a) 传统 万 向 节 式 陀螺 仪 (万 向 节 保证 了 陀螺 仪 在 其 基部 。 罗盘 在 东道 上 旋转 ， 转 轴 与 地 球 的 转轴 一 致 而 转轴 下 
被 动 旋转 的 时 候 ， 仍 能 够 围绕 转轴 旋转 的 自由 度 ) by — — 方 的 配 重 自然 下 垂 。 当 地 球 转动 时 ， 罗 盘 的 转轴 保持 


个 围绕 地 球 旋转 的 陀螺 仪 (陀螺 仪 的 转轴 (图 中 灰色 部 静止， 而 看 上 去 也 是 静止 的 。 现 在 ， 让 我 们 想象 如 果 
位 ) 在 陀螺 仪 围绕 地 球 转动 的 时 候 保 持 同 一 方向 。 对 与 地 罗盘 的 转轴 不 是 与 地 球 的 转轴 一 致 ， 而 是 与 赤道 的 方 
求 同 步 的 观测 者 来 说 ， 陀 螺 仪 始终 在 转动 。) 向 一 致 ， 当 地 球 转动 时 ， 罗 盘 的 转轴 将 向 转 出 纸 面 的 
ahe Ej > pe 寺 原 Al MZ ] 

尽管 这 种 全 局 性 的 转动 限制 了 机 械 式 陀螺 仪 感知 SER, AERARMEA, SER AR 
时 ,下方 的 配 重 将 被 抬 起 而 重力 就 产生 一 个 力矩 。 此 

绝对 方位 角 的 能 力 ， 它 还 是 可 以 用 来 测量 局 部 性 的 方 。 Haas AA is 
P Si uci 时 ， 与 转轴 和 力矩 同时 保持 垂直 的 方向 将 使 转轴 偏离 
ian ai 已 知 的 赤道 方向 而 向 地 球 的 极点 转 去 。 人 整个 过 程 如 图 
速率 陀螺 仪 测量 交通 工具 的 转速 ( 即 其 旋转 的 角 束 bn 人 


20. 示 。 
度 ) 。 这 种 基本 测量 是 所 有 陀螺 仪 系统 的 基础 。 速 率 20. b PU 


= 
| 
| 


转 轮 


配 重 水 平 轴 


地 球 自转 一 自 西向 东 一 一 > 


工 -力气 
P - 精度 
a) b) 


El 20.3 简易 的 旋转 罗盘 系统 
a) 钟 摆 式 陀螺 仪 b) 旋 进 运动 


不 幸 的 是 ， 钟 摆 式 陀螺 仪 不 是 理想 的 导航 仪器 。 ”作为 平衡 量 ， 并 且 限 制 了 油 在 池内 的 运动 ” 。 
尽管 它 的 转轴 能 与 地 球 转轴 保持 一 致 ， 但 它 并 不 是 固 钟 摆 式 旋转 罗盘 通过 控制 陀螺 仪 的 旋 进 来 找到 真 
定 于 这 一 个 状态 而 是 在 其 左右 来 回 振荡 。 这 类 阻尼 问 。 ” 正 的 地 球 北极 方向 。 实 际 上 ， 作 用 于 机 械 式 旋 转 罗盘 
题 的 解决 方案 是 使 用 一 个 油 池 ， 而 不 是 一 个 国体 配 重 ”的 外 力 会 影响 到 陀螺 仪 的 旋 进 ， 也 会 影响 到 罗盘 的 性 
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能 。 这 些 外 力 既 包括 了 整个 罗盘 装置 的 旋转 所 产生 的 
力 ， 也 包括 了 任何 作用 于 交通 工具 本 身 的 外 力 。 有 关 
机 械 式 旋 转 罗盘 的 男 一 个 问题 是 ， 在 距离 赤道 较 远 的 
纬度 ， 罗 盘 的 稳定 位 置 不 是 水 平 的 ， 而 在 这 种 纬度 ， 
需要 校正 陀螺 仪 的 原始 数据 才能 得 到 对 地 球 正 北 的 准 
确 测量 。 最 后 ， 机 械 式 旋转 罗盘 需要 一 个 外 力作 用 于 
罗盘 才能 维持 陀螺 仪 的 持续 转动 。 这 个 过 程 引 入 了 测 
量 系统 本 不 需要 的 外 力 ， 造 成 了 测量 过 程 的 额外 
误差 。 

考虑 到 机 械 式 旋转 罗盘 的 复杂 度 、 造 价 、 尺 寸 和 
独特 的 属性 ， 以 及 成 本 更 低 、 性 能 更 可 靠 的 技术 的 出 
现 ， 机 械 式 旋转 罗盘 已 经 让 位 给 光学 式 陀螺 仪 和 微型 
机 电 系 统 陀螺 仪 。 


光学 式 系统 


光学 式 陀螺 仪 并 不 依靠 旋转 惯量 ,而 是 依靠 
Sagnac 效 应 来 测量 (相对 ) 航向 角 。Sagnac 效应 的 原 
理 基 于 在 一 个 转动 系 的 光学 驻 波 的 运动 特性 。 这 种 系 
统 在 陀螺 仪 史 上 最 初 是 通过 使 用 激光 和 反射 镜 的 设置 
实现 的 ， 而 现在 通常 采用 光纤 技术 来 实现 。Sagnac 效 
应 以 它 的 发 现 者 Georges Sagnac tit! 1, [Hf HE 
根本 原理 可 以 追溯 到 更 早 的 Harress AY E09 97, qj 
Sagnac 效应 最 著名 的 应 用 可 能 是 用 于 地 球 旋转 的 
ii eoo e 

为 了 研究 Sagnac 效应 ， 如 图 20. 4a 所 示 ， 我 们 需 
要 和 忽略 相对 运动 而 只 考虑 图 中 圆 形 的 光线 路 径 。 如 果 
两 束 光线 从 周 长 为 D 22«R 的 静止 路 径 的 同一 点 向 相 
反 的 方向 以 相同 速度 出 发 ,那么 它们 将 同时 回 到 起 
点 ， 用 时 为 1= D/e (c 为 光 在 此 媒介 中 的 速度 ) 。 现 
在 ， 让 我 们 假设 圆 形 的 路 径 并 不 是 静止 的 ， 而 是 以 角 
速度 w 围绕 其 中 心 顺 时 针 转 动 ， 如 图 20. 4b 所 示 。 那 
么 沿 顺 时 针 方向 前 进 的 光线 将 需要 走 更 长 的 路 程 才能 
到 达 起 点 ， 而 沿 逆 时 针 方向 行进 的 光线 则 需要 走 更 短 
的 路 程 。 假 设 i 是 光线 沿 顺 时 针 方 向 回 到 起 点 的 时 
间 ， 那 么 沿 顺 时 针 方 向 的 路 径 长 度 则 是 D, =2TmR + 
oRt,; 类 似 的 ， 假设 i 是 光线 沿 逆 时 针 方 向 回 到 起 点 
的 时 间 ， 那 么 沿 逆 时 针 方 向 的 路 径 长 度 则 是 D, = 
2T7R -wRt,。 我 们 还 有 D, =ct, 和 D,=ct,， 因 此 1 = 
2mR/(c-oR), Mit, 22mR/(c* wR)， 两 者 的 差 At = 


t, =t M 


20. 2. 2 


1 1 
Ai son ( —x or) 


测量 出 时 间 差 Ax， 角 速度 w 就 可 以 求 得 了 。 需 要 指 
出 的 是 ， 尽 管 以 上 推导 是 建立 在 经 典 力学 的 基础 上 而 
忽略 了 相对 效应 ,但 是 同样 的 推导 在 考虑 了 相对 速度 


以 后 也 同样 适用 ， 能 得 到 相同 结果 '”"。 有 关 Sa- 
gnac 效应 和 环形 激光 的 深入 回顾 请 参阅 参考 文献 
[20.16], 


E 
[s 


开始 结束 


a) b) 


图 20.4 圆 形 光线 路 径 
a) 静止 路 径 b) 运动 路 径 


光学 式 陀螺 仪 通常 采用 激光 作为 光源 。 光 学 式 
陀螺 仪 通常 有 三 种 不 同 的 实现 方法 。 第 一 种 采用 镜 
面 表面 的 直线 光线 路 径 。 第 二 种 则 是 采用 放置 于 系 
统 边际 的 棱镜 来 导向 光束 ， 也 即 环形 激光 陀螺 仪 
(RLG) 。 最 后 一 种 则 是 应 用 偏振 现象 来 保持 玻璃 光 
纤 圈 ， 也 即 光 纤 式 光学 陀螺 仪 FOG), Kk, 3 
璃 光纤 可 能 环绕 多 圈 以 延长 光线 的 有 效 路 径 。 顺 时 
针 和 逆 时 针 方 向 的 时 间 差 则 通过 测量 顺 、 逆 时 针 方 
向 的 光学 信号 的 相位 干涉 来 计算 。 而 多 个 光学 式 陀 
螺 仪 可 以 沿 不 平行 的 方向 装置 在 一 起 以 测量 三 维 
(3-D) 的 旋转 。 

用 以 测量 顺 、 逆 时 针 方向 两 条 路 径 之 间 的 时 间 差 
的 方法 也 有 很 多 ， 其 中 包括 了 测量 激光 由 于 陀螺 仪 的 
运动 产生 的 多 普 勒 频 移 以 及 测量 顺 、 逆 时 针 方向 之 间 
干涉 模式 下 的 拍 频 所 ”1 。 环 形 干 涉 仪 通常 拥有 多 条 
光纤 线圈 。 这 些 线圈 引导 光线 在 圈 内 以 固定 的 频率 向 
相反 方向 传播 ， 从 而 测量 相位 差 。 一 个 环形 激光 通常 
包括 了 一 个 环形 的 激光 谐振 腔 。 光 线 沿 着 这 个 谐振 腔 
的 两 个 相反 方向 做 环形 传播 ， 产 生 了 沿 这 两 个 方向 上 
有 相同 数目 节点 的 两 个 驻 波 。 因 为 激光 路 径 沿 这 两 
个 方向 的 长 度 不 同 ， 激 光 的 谐振 频率 也 就 不 同 ， 频 率 
差 就 被 测量 出 来 。 对 于 环形 激光 陀螺 仪 来 说 ， 一 个 不 
好 的 副 效应 是 两 个 激光 信和 号 会 在 小 幅度 旋转 时 相互 锁 
定 。 为 了 确定 这 种 锁定 效应 不 会 发 生 ， 通 常 整个 装置 
需要 以 一 种 固定 的 方式 旋转 。 


20.2.3 ”微型 机 电 系 统 


几乎 所 有 的 微型 机 电 系统 陀螺 仪 都 是 基于 振动 的 
机 械 部 件 来 测量 转动 的 。 振 动 式 陀螺 仪 依赖 基于 科 氏 
( Coriolis) 加 速度 的 振动 模式 的 转变 引起 的 能 量 
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移 。Coriolis 加 速度 是 在 一 个 旋转 的 坐标 系 中 产生 的 
明显 的 加 速度 。 假 设 一 个 物体 在 一 个 旋转 的 坐标 系 中 
沿 直 线 前 进 ， 那 么 对 于 一 个 位 于 这 个 坐标 系 外 面 的 观 
测 者 来 说 ， 这 个 物体 运动 的 路 径 在 惯性 系 中 是 弯曲 
的 。 这 就 造成 了 对 一 个 旋转 的 观测 者 来 说 ， 必 须 有 一 
种 力 去 作用 在 这 个 物体 上 以 使 得 此 物体 仍 保持 直线 运 


3. 酒杯 谐振 器 陀螺 仪 
酒杯 谐振 器 陀螺 仪 则 通过 测量 一 个 酒杯 形 振荡 结 
构 的 节点 位 置 的 Coriolis 力 来 达到 测量 外 部 转动 的 
目的 。 

因为 微型 机 电 系 统 陀螺 仪 没有 旋转 元 件 ， 符 合 耗 
电量 低 的 要 求 ， 并 且 尺 寸 很 小 ， 它 很 快 地 就 取代 了 机 


动 状 态 。 假 设 一 个 物体 在 一 个 相对 于 惯性 系 以 角速度 
2 旋转 的 坐标 系 中 ， 以 局 部 速度 v 做 直线 运动 ， 产 生 
的 Coriolis 加 速度 a 则 为 
a=2vxQ 

在 一 个 微型 机 电 系 统 陀螺 仪 中 转换 加 速度 意味 着 
可 以 引入 局 部 线 速度 并 可 以 测量 因此 造成 的 Coriolis 
加 速度 。 
早期 的 微型 机 电 系 统 陀螺 仪 使 用 振动 石英 晶体 来 
产生 必要 的 线性 运动 。 近 期 的 设计 则 以 硅 基 振动 器 取 
代 了 振动 石英 晶体 。 人 们 开发 了 许多 种 不 同 的 微型 机 
电 结 构 ， 下 面 对 其 中 一 些 进 行 介 绍 。 

1. 音叉 陀螺 仪 
音叉 陀螺 仪 采 用 一 种 类 似 音叉 的 结构 (E 
20.5) 作为 基本 机 制 。 当 音叉 在 一 个 转动 的 坐标 系 
中 振荡 时 ，Coriolis 力 将 使 音叉 的 尖 头 向 音 又 所 在 的 
平面 外 振动 ， 而 这 种 力 是 可 以 测量 的 。InertiaCube f£ 
感 器 就 采用 了 这 种 效应 。 


驱动 震荡 
[ 感应 的 震 东 


旋转 
图 20.5 微型 机 电 系 统 陀螺 仪 : 运转 原理 


2. 振动 轮 陀 螺 仪 

振动 轮 陀 螺 仪 使 用 一 种 围绕 其 转轴 振荡 的 轮子 。 
坐标 系 额 外 的 转动 致使 轮子 倾斜 ， 通 过 测量 这 种 倾斜 
可 以 测量 旋转 。 


械 式 和 光学 式 陀螺 仪 在 机 器 人 中 应 用 的 地 位 。 
20.2.4 性 能 


惯性 传感器 的 性 能 主要 由 一 些 因素 决定 。 我 们 列 
举 了 如 下 三 点 。 

1) 可 重复 性 偏差 。 这 是 陀螺 仪 在 恒温 条 件 下 ， 
在 固定 惯性 运行 中 的 最 大 测量 偏差 ， 即 在 理想 操作 条 
件 下 的 最 大 测量 偏差 。 在 不 同 的 时 标 下 ， 可 以 测量 出 
短期 或 长 期 可 重复 性 偏差 。 
2) 角度 随机 游 动 。 主 要 用 以 测量 陀螺 仪 角速度 
数据 中 的 噪声 。 
3) 比例 因子 系数 。 这 个 因素 并 不 是 惯性 传 感 需 
或 陀螺 仪 特 有 的 ， 而 是 一 种 信号 幅度 的 基本 度量 。 它 
测量 了 传感器 的 整体 模拟 输出 量 与 有 用 输出 量 的 比 
率 。 对 一 个 陀螺 仪 来 说 ， 通 常 ， 比 例 因子 系数 的 单位 
JémV/ [ (°) «s^ ]);， 而 对 加 速度 仪 来 说 ， 比 例 因 
子 系数 的 单位 通常 是 (mV/(m *s7)). 


小 结 


20.2.5 


除了 旋转 罗盘 以 外 ， 陀 螺 仪 测量 的 是 围绕 一 
个 旋转 轴 的 相对 旋转 运动 。 不 同 的 陀螺 仪 利 用 旋 
转 坐 标 系 的 不 同属 性 来 达到 测量 这 种 旋转 运动 的 
目的 。 早 期 的 机 械 式 陀螺 仪 已 经 让 位 于 光学 式 和 
微型 机 电 系 统 陀 螺 仪 ， 但 是 基本 运作 原理 保持 不 
变 ， 即 利用 旋转 坐标 系 的 不 同属 性 来 测量 相对 旋 
转运 动 。 

对 所 有 陀螺 仪 来 说 偏差 是 一 个 共同 的 问题 。 每 一 
种 相对 运动 的 测量 都 有 不 同 的 测量 误差 ， 而 这 些 误差 
随时 间 累 积 。 这 样 ， 每 一 种 陀螺 仪 技术 都 有 特定 的 测 
量 偏 差 存 在 。 除 非 这 些 偏差 能 被 其 他 的 (外 部 的 ) 
测量 手段 纠正 ， 否 则 ， 偏 差 的 大 小 将 迟早 超过 测量 需 
要 的 准确 度 。 

因为 一 个 单一 的 陀螺 仪 只 能 测量 一 条 单一 的 旋转 
轴 的 转动 ， 通 常 可 以 将 三 个 单一 传感器 安置 在 三 个 互 
相 垂直 的 旋转 轴 上 以 测量 三 维 的 运转 。 这 种 三 维 陀螺 
仪 通常 会 跟 其 他 传感器 〈 如 罗盘 和 加 速度 仪 等 ) 整 
合 在 一 起 ， 以 形成 惯性 传感器 (IMU)。 我 们 将 在 第 
20. 4 节 介绍 惯性 传感器 。 
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度 仪 


正如 陀螺 仪 可 以 用 来 测量 一 个 机 器 人 方向 的 变 
化 ， 男 一 类 惯性 传感器 一 一 加 速度 仪 ， 可 以 测量 作用 
于 机 器 人 的 外 力 。 一 个 有 关 加 速度 仪 的 很 重要 的 因素 
是 它们 对 所 有 外 加 的 作用 力 ， 包 括 重力 ， 都 敏感 。 加 
速度 仪 采用 多 种 不 同 的 机 制 把 外 力 转换 为 计算 机 可 读 
的 信号 。 

1. 机 械 式 加 速度 仪 

一 个 机 械 式 加 速度 仪 基本 上 是 由 一 个 弹簧 - 配 重 - 
阻尼 (SL 20. 6a) 组 成 的 系统 ， 并 能 提供 一 些 方法 
用 以 外 部 观测 。 当 一 个 外 力 ( 比如 重力 ) 施加 于 加 
速度 仪 ， 这 个 力量 作用 于 配 重 而 使 弹簧 发 生 形变 。 假 
设 一 个 理想 的 弹簧 ， 它 的 形变 正比 于 作用 力 ， 内 外 力 


20.3 ”加速 


平衡 ， 方 程 是 
F soptied =F inertiat t E tamping + F spring 
=m tex +hx 
式 中 ,是 阻尼 系数 。 可 以 通过 求解 这 个 方程 看 出 ， 


依靠 与 需要 施加 的 外 力 和 配 重 有 关 的 阻尼 系数 的 大 
小 ， 这 个 系统 可 以 在 一 段 合 理 的 、 较 短 的 时 间 内 达 
到 一 个 稳定 状态 ,不 论 有 没有 一 个 静态 的 力作 用 于 
系统 本 身 。 因 为 需要 事先 预测 需要 施加 的 外 力 的 大 
小 以 及 系统 需要 达到 稳定 状态 的 作用 时 间 (可 能 
很 长 ) ， 并 且 这 些 因 素 与 达 不 到 理想 条 件 的 弹簧 相 


pri 


b) 


图 20.6 加 速度 仪 
a) 机 械 式 加 速度 仪 b) 压 电 式 加 速度 仪 


耦合 ， 就 进一步 限制 了 机 械 式 加 速度 仪 的 应 
机 械 式 加 速 
敏感 。 
2. 压 电 式 加 速度 仪 

不 用 像 机 械 式 加 速度 仪 那 样 去 直接 测量 施加 外 
力 的 大 小 ， 压 电 式 加 速度 仪 是 基于 一 些 晶体 呈现 出 
的 特性 ， 这 种 特性 使 这 些 晶 体 可 以 在 被 压迫 时 产生 
一 个 电压 。 可 以 恰当 的 放置 一 小 块 配 重 使 它 只 被 品 
这 样 有 外 力 施 加 于 加 速度 仪 上 时 ， 配 重 就 

晶体 以 产生 一 个 可 以 测量 出 来 的 电压 ， 如 图 


p] 


o 


度 仪 的 另 一 个 问题 是 它们 对 振动 特别 


4 


rim 
20.4 惯性 传感器 套装 


一 个 惯性 传感器 (IMU), ， 是 指 一 
仪 和 加 速度 仪 等 测量 系统 ,来 预测 一 个 运动 中 的 交 
通 工具 相对 人 位置、 速度 和 加 速度 的 装置 。 由 惯性 传 
感 咒 形成 的 导航 系统 就 是 惯性 导航 仪 (INS)。 在 
1949 年 ， 第 一 次 由 C. S. Draper 演示 ， 惯 性 传感器 成 
为 一 种 飞机 和 舰 船 常用 的 导航 器 件 。 一 直 以 来 ， 惯 
性 传感器 是 一 种 设备 齐全 的 (或 独立 的 ) 、 不 借助 
外 部 校正 的 、 可 以 提供 导航 测量 的 装置 。 但 是 这 种 
定义 最 近 变 得 不 够 准确 了 。 这 是 因为 ， 近 年 来 人 们 
越 来 越 倾 向 于 认为 惯性 传感器 系统 也 可 以 包括 外 部 
的 校正 。 

惯性 传感器 基本 上 分 为 两 大 类 ， 万 向 节 式 系统 和 
捷 连 式 系统 。 正 如 名 字 所 暗示 的 那样 ， 万 向 节 式 惯性 
传感器 安装 于 复杂 的 万 向 节 机 构 内 部 以 形成 一 个 稳定 
的 测算 平台 。 这 种 系统 使 用 陀螺 仪 以 确保 万 向 节 与 加 
电 时 的 初始 坐标 系 保 持 一 致 。 相 对 于 交通 工具 万 向 节 
平台 的 方位 角 一 般 用 来 把 在 惯性 传感器 内 取得 的 测量 
值 映射 到 交通 工具 的 参考 坐标 系 中 。 另 一 方面 ， 捷 连 
式 惯 性 传感器 ， 则 需要 将 传感器 固定 地 连接 在 交通 工 
AE ( 捷 连 ) ， 因 而 不 需要 万 向 节 这 样 的 转换 。 不 管 
采取 哪 种 方式 ， 总 是 需要 实时 地 获取 惯性 传感器 
(加 速度 仪 、 陀 螺 仪 等 ) 内 的 传感器 所 得 的 积分 数 
据 ， 才 能 获得 相对 于 初始 坐标 系 的 运动 的 预测 。 这 种 
积分 对 于 早期 使 用 的 惯性 传感器 来 说 是 沉重 的 计算 负 
担 ， 因 而 历史 上 ($F 1970 ^E), ， 万 向 节 惯 性 传 感 
器 更 为 常用 。 鉴 于 现代 实现 这 种 积分 已 经 非常 廉价 ， 


种 利用 如 陀螺 


反而 是 制造 和 操作 万 向 节 系 统 的 费用 较 高 ， 捷 连 式 惯 
性 传感器 已 经 变 得 更 为 常用 了 [mm 。 


一 个 完备 的 惯性 传感器 可 以 对 交通 工具 的 姿态 进 
行 6 个 自由 度 上 的 预测 。 这 6 个 自由 度 是 位 置 (x, 
y, z) 和 方向 (roll, pitch, yaw) 。 类 似 于 惯性 传 感 
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器 的 系统 ， 比 如 ， 仅 测量 实时 方向 角 的 系统 通常 称 为 
姿态 航向 参照 系统 。 这 种 系统 跟 惯 性 传感器 的 运作 方 
式 相 似 ， 但 是 只 测量 了 交通 工具 的 一 部 分 状态 。 除 了 
上 述 的 6 个 自由 度 以 外 ， 商 用 的 惯性 传感器 通常 还 提 
供 速 度 和 加 速度 的 测量 。 

惯性 传感器 的 基础 计算 功能 如 图 20.7 所 示 。 此 
传感器 使 用 了 三 个 相互 垂直 的 加 速度 仪 和 三 个 相互 垂 
直 的 陀螺 仪 。 对 陀螺 仪 的 数据 w 进 行 积分 以 持续 地 预 
测 装 有 此 传感器 的 交通 工具 的 方位 角 g。 同 时 ， 三 个 
加 速度 仪 用 以 预测 交通 工具 的 瞬时 加 速度 a。 将 此 加 
速度 根据 现 有 的 交通 工具 相对 于 重力 的 方位 角 的 预测 
进行 转换 。 这 样 ， 重 力 因子 可 以 被 测量 出 来 并 且 从 加 
速度 中 扣除 。 将 剩余 的 加 速度 进行 积分 就 能 得 到 交通 


速率 陀螺 仪 方向 角 积 分 


- 具 的 速度 vy， 青 次 进行 积分 就 能 得 到 位 置 r。 
惯性 传感器 对 陀螺 仪 和 加 速度 仪 数据 中 潜在 的 测 
量 误差 非常 敏感 。 陀 螺 仪 的 偏差 常常 导致 机 融 人 相对 
于 重力 的 方位 角 产 生 误 测 ， 并 进一步 导致 重力 因子 的 
误 扣除 。 这 样 ， 当 误 扣除 的 加 速度 被 积分 两 次 得 到 位 
置 时 ， 误 扣除 的 重力 因子 就 会 在 位 置 结果 中 产生 二 次 
方 的 误差 ”" 。 因 为 重力 因子 的 扣除 永远 不 能 做 到 
彻底 完全 ， 青 加 上 其 他 偏差 .经 过 两 次 积分 ， 这些 误 
差 就 构成 了 惯性 传感器 准确 度 的 基本 问题 。 运 转 足 够 
长 的 时 间 后 ， 所 有 的 惯性 传感器 都 将 偏 移 ， 而 必须 使 
用 相关 特定 的 外 部 测量 数据 进行 校正 。 对 许多 野外 机 
项 人 来 说 ， 全 球 定位 系统 就 是 一 种 提供 这 种 外 部 校正 


的 有 效 来 源 。 
EN LEN 


积分 成 位 置 


加 速度 速度 位 置 
图 20.7 惯性 传感器 基础 计算 功能 


20.5 全 球 定位 系统 


全 球 定位 系统 (GPS) 是 应 用 最 广泛 的 定位 预测 
装置 。 它 提供 了 包括 当前 时 间 和 日 期 在 内 的 ， 三 维 绝 
对 坐标 系 位 置 预测 。 这 种 预测 可 以 是 地 球 表 面 上 的 任 
何 一 个 位 置 。 标 准 的 全 球 定位 系统 可 以 在 水 平面 内 提 
供 误差 在 20m 以 内 的 位 置 预测 。 最 初 ， 全 球 定位 系 
统 是 为 军事 应 用 设计 的 ， 而 后 被 广泛 应 用 于 民事 项 
目 。 包 括 自 主 车 辆 导航 系统 ， 娱 乐 性 的 定向 越野 比赛 
和 运输 公司 的 存货 追踪 等 。 


20.5.1 概论 


全 球 定 位 系统 基于 接收 围绕 地 球 做 固定 轨道 旋转 
的 一 组 卫星 发 射 的 无 线 电 信和 号 进行 方位 计算 。 在 比较 
从 不 同 的 卫星 接收 到 的 信号 的 时 间 延 迟 后 ， 方 位 就 能 
被 计算 出 来 。 最 广泛 应 用 的 全 球 定位 系统 是 基于 由 美 
国 开 发 的 NAVSTAR 卫星 系统 。 这 套 系 统 是 由 美国 空 
军 太空 司令 部 开发 并 维持 运转 的 。 作 为 一 种 军事 设 
施 ， 美 国政 府 保 留 了 终止 和 修改 这 套 系统 的 可 用 性 的 


权力 。 另 一 套 类 似 的 系统 叫做 人 造 地 球 卫星 全 球 导航 
系统 (GLONASS), ， 是 由 俄罗斯 政府 运行 的 。 但 是 这 
套 系统 在 撰写 本 书 的 时 候 还 没有 应 用 于 机 器 人 领域 。 
另 一 套 替 代 系 统 是 由 欧盟 开发 的 ， 取 名 为 伽利略 
(Galileo) 的 系统 。 这 套 系 统 的 开发 目的 明确 ， 就 是 
要 脱离 军事 的 控制 。 伽 利 略 系统 将 提供 两 个 级 别 的 服 
务 : 一 种 是 开放 式 的 服务 ; 另 一 种 则 是 加 密 高 质量 的 
商务 服务 。 其 余 的 全 球 定位 系统 例如 中 国 的 北斗 系统 
或 日 本 的 QZSS 系统 则 不 在 本 章 的 讨论 范围 。 

通常 的 全 球 定位 系统 总 是 指 NAVSTAR 系统 。 一 
直 以 来 ， NAVSTAR 提供 两 种 不 同 的 服务 : 一 种 是 精 
确定 位 系统 (PPS) ， 专 为 军事 使 用 保留 ; 另 一 种 是 
准确 度 较 低 的 标准 定位 系统 (SPS ) 。 两 种 服务 的 不 
同 就 在 于 选择 可 用 性 (SA) 。 这 种 在 SPS 信号 中 人 为 
地 引进 伪 随 机 噪声 造成 准确 度 的 下 降 是 当时 出 于 战略 
原因 考量 的 ， 并 于 2001 年 撤销 。 尽 管 这 种 人 为 地 降 
低 准确 度 在 原则 上 还 是 可 以 再 实现 的 ,但 是 因为 全 球 
定位 系统 在 近 十 年 里 的 广泛 商业 应 用 ， 再 进行 人 为 降 
低 准 确 度 似 乎 不 大 可 能 。 但 是 ， 即 便 是 现在 ， 全 球 定 
位 系统 网 络 中 使 用 的 ， 采 用 准确 度 加 密 代码 (P 
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(Y)) 的 辅助 性 数据 ， 还 是 没有 开放 给 民间 使 用 者 。 

全 球 定位 系统 的 卫星 网 络 是 基于 一 个 24 颗 在 轨 
卫星 的 基本 星 群 ， 再 加 上 6 颗 其 实 也 在 运转 的 辅助 卫 
星 。 这 些 卫 星 都 是 处 于 近乎 圆 形 的 地 球 中 轨道 。 与 对 
地 静止 轨道 不 同 的 是 ， 这 些 卫 星 的 轨道 是 半 同 步 的 ， 
意味 着 对 一 个 地 面 上 的 观测 者 来 说 ， 轨 道 的 位 置 是 持 
续 变 化 的 ， 并 且 轨 道 的 周期 都 是 准确 的 半 恒 星 日 。 之 
所 以 这 样 选择 卫星 的 轨道 ， 是 因为 这 样 的 话 几 乎 在 地 
球 表面 上 的 任意 一 点 ， 都 可 以 观测 到 至 少 4 颗 卫 星 ， 
而 这 也 正 是 全 球 定 位 系统 进行 位 置 预测 的 标准 。 所 有 
24 颗 卫 星 被 平均 安排 在 6 个 轨道 面 ， 这 样 每 个 轨道 
面 就 各 有 4 颗 了 卫星。 系统 这 样 设计 以 保证 在 24h 的 间 
隔 内 ， 卫 星 平均 覆盖 整个 地 球 表 面 ; 而 在 24h 内 ， 即 
便 是 位 置 最 差 的 地 点 ， 也 能 保持 99.9% 的 覆盖 率 ，; 
而 在 30d 的 测量 间隔 里 ，24h 内 地 球 上 位 置 最 差 的 地 
点 ， 也 至 少 有 83.92% 的 信号 有 效率 。 需 要 指出 的 
是 ， 有 效 性 的 标准 考量 了 传输 操作 因素 ， 而 不 仅仅 是 
覆盖 率 的 问题 。 当 然 ， 此 标准 忽略 了 实际 的 像 高 山 之 
类 的 地 形 特 点 ， 以 及 其 他 物体 ， 比 如 可 能 隔断 视线 的 
高 楼 等 。 
每 一 颗 卫 星 反复 地 广播 出 一 个 被 称 为 C/A 码 的 
数据 包 。 数 据 包 以 频率 1575. 42MHz 由 接收 器 在 L1 
信道 接收 。 这 个 简单 的 原理 是 ， 如 果 接 收 器 知道 被 观 
测 卫星 的 绝对 位 置 的 话 ， 接 收 器 自身 的 位 置 也 可 以 直 


图 20.8 全 球 定位 系统 在 地 面 上 的 三 边 测量 术 
图 20.8 中 ,假设 同时 从 三 个 已 知 位 置 的 发 射 器 (A. BA 
C) 接收 到 信号 。 如 果 知 道 其 中 一 个 发 射 器 (比如 说 A) 的 
信号 延迟 ， 则 能 够 将 接收 器 的 位 置 约束 在 一 个 以 发 射 器 为 圆 


b, JERR (da) 为 直径 的 圆 弧 上 。 同 时 来 自 两 个 发 
射 器 的 约束 则 至 多 相交 于 两 个 点 。 第 三 个 发 射 器 则 用 来 区 分 
这 两 个 交点 以 确定 真正 的 接收 器 所 在 的 位 置 。 在 三 维 坐标 系 


接 得 到 ; 或 者 如 果 无 线 电 信和 号 传播 的 时 间 是 已 知 的 
话 ， 接 收费 的 位 置 同样 可 以 通过 三 边 测量 术 计 算出 


里 面 ， 第 一 个 发 射 器 传播 的 信号 将 接收 器 的 位 置 约束 在 一 个 
球面 上 。 来 自 两 个 发 射 器 的 约束 则 相交 并 将 接收 如 的 位 置 约 


( 见 图 20.8) 。 这 就 意味 着 接收 需 必 须 设 有 可 以 获得 
绝对 时 间 的 元 件 。 这 种 元 件 对 接收 器 来 说 可 能 造价 太 
高 而 不 实际 。 取 而 代 之 的 是 ， 卫 星 上 具有 极度 准确 的 


束 在 一 个 圆 形 上 。 来 自 三 个 发 射 器 的 约束 则 相交 并 将 接收 
器 的 位 置 定位 于 一 个 或 两 个 点 。 


便 没 有 密码 解密 匙 ， 还 是 可 以 通过 使 用 加 密 的 L2 信 


原子 钟 (精度 接近 1s 每 300 000 年 ) 。 接 收 器 计算 从 
不 同 的 卫星 接收 到 信号 的 时 间 差 ， 并 利用 这 个 时 间 差 
计算 出 被 称 为 伪 距 的 距离 预测 值 。 伪 距 这 个 用 法 表明 
了 这 个 距离 值 被 几 种 来 源 的 测量 噪声 所 污染 。 这 个 特 
定 的 几何 学 问题 被 称 为 多 点 定位 技术 或 者 双 曲 线 定位 


号 来 提供 额外 的 误差 纠正 (用 L2. 信号 来 观测 以 频率 
为 变量 的 电离 层 干扰 函数 造成 的 相对 效应 ) 。 同 时 在 
Ll 和 12 信道 上 广播 的 访问 受 限 信号 是 P 代码 (和 最 
近 推 出 的 M 代码 )。 此 代码 在 加 密 后 被 称 为 Y 代码 或 
P (Y), P/Y RB., C/A 信息 和 了 (Y) 代码 都 包含 


技术 。 结 果 通 常 是 由 接收 器 里 面 一 个 复杂 的 卡尔 曼 滤 


了 导航 信息 流 。 这 些 信息 流明 确 了 时 钟 偏差 数据 、 轨 


波 器 计算 得 出 。 为 了 避免 需要 记 住 每 一 个 卫星 的 星 历 
(姿态 ) 表 ， 和 在 接收 器 上 使 用 非常 精准 的 时 钟 ， 每 
一 颗 卫 星 在 传播 的 数据 包 里 面 广播 自己 的 位 置 和 一 个 
精确 的 时 钟 信号 。 

全 球 定位 系统 的 卫星 以 L1 到 L5 之 间 的 几 个 频率 
进行 广播 , 其 中 只 有 Ll (1575.42MHz) 和 12 
(1227.6MHz) H F REHAB M Eo M 
NAVSTAR 提供 的 标准 设备 以 及 该 设备 的 性 能 标准 取 
BEF LI 信号 。 信 号 包含 两 部 分 不 加 密 的 内 容 ， 捕 获 
信息 (C/A 信息 ) 和 一 条 导航 数据 信息 。 同 时 ， 即 


道 信息 、 电 离 层 传播 校正 因子 、 星 历 表 、 所 有 卫星 的 
状态 信息 、 世 界 时 钟 代码 以 及 其 他 信息 。 卫 星 的 性 能 
则 由 坐落 于 美国 科罗拉多 州 科 罗拉 多 斯 普 林 斯 市 附近 
的 施 里 弗 空 军 基 地 的 主 控 制 基站 统一 协调 控制 。 该 主 
基站 与 位 于 世界 各 地 (美国 卡 纳 维 拉 尔 角 、 阿 森 松 
岛 、 马 绍 尔 群 岛 的 奔 机 林 环 礁 、 迪 戈 加 西亚 环 礁 和 夏 
RR) 的 其 余 五 个 监控 基站 连 成 全 局 网 络 用 以 产生 
测量 值 并 上 传 到 卫星 上 ， 生 成 导航 信息 流 。 最 后 需要 
指出 的 是 L2 信道 上 多 了 一 个 额外 信号 可 用 。 这 种 位 
于 卫星 上 指定 的 IR-M 模块 上 的 L2C 信号 能 保证 大 
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幅度 提升 接收 需 的 敏感 度 。 这 将 有 助 于 在 现 有 的 一 些 
不 能 够 取得 定位 信息 的 环境 中 ， 比 如 森林 里 ， 获 得 接 
收 器 的 定位 。 


20.5.2 ”性 能 因素 


全 球 定位 系统 的 性 能 取决 于 几 点 因素 : 卫星 传输 
准确 度 、 环 境 条 件 、 信 和 号 与 地 面 上 障碍 物 的 交互 以 及 
接收 器 的 性 能 。 

在 机 器 人 应 用 的 背景 里 ， 影 响 卫星 自身 性 能 的 
素 和 大 气 层 条 件 状 况 基 本 上 是 无 法 控制 的 。 只 是 ， 需 
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星 数 、 预 测 器 中 考虑 的 因子 数 和 辅助 定位 系统 如 广 域 
增强 系统 (WAAS， 见 20. 5.3 节 ) 。 一 个 决定 定位 预 
测 产生 快慢 的 主要 因素 是 定位 系统 内 的 独立 接收 元 件 
的 数量 。 序 列 单 信道 接收 器 简单 而 较为 经 济 (尺寸 
可 能 也 较 小 ) ， 但 是 它们 必须 顺序 锁定 每 一 个 需要 用 
到 的 卫星 信号 。 并 行 多 信道 接收 器 可 以 同时 锁定 多 个 
卫星 ， 因 而 定位 比较 快 而 且 造 价 也 比较 高 。 一 定 程度 
的 并 行 度 是 高 质量 消费 级 电子 类 设备 的 规范 。 

全 球 定位 系统 的 计算 是 基于 对 所 谓 精 度 衰减 因 


要 注意 的 是 ， 正 是 这 些 不 可 控制 的 因素 可 以 构成 导致 
全 球 定位 系统 的 信号 不 能 始终 可 靠 的 误差 源 。 当 定位 
设备 表现 出 非典 型 性 错误 行为 〈 比 如 不 正确 的 信号) 
时 ， 这 种 情况 定义 为 服务 失效 。 这 种 失效 可 以 分 类 为 
一 般 失 效 和 严重 失效 。 一 般 失效 是 指 给 接收 天 造成 了 


子 ， 尤 其 是 针对 系统 中 的 定位 部 分 的 精度 衰减 因子 的 
估 测 ， 即 位 置 精度 衰减 因子 (PDOP)。 这 个 定义 对 
应 于 误差 关于 定位 预测 的 偏 导 数 并 且 使 得 系统 能 在 任 
何 时 刻 确 认可 用 于 最 准确 定位 预测 的 卫星 组 。 全 球 定 
位 系统 的 标准 实施 中 指定 了 每 Smin 重新 计算 一 次 位 


有 限 的 影响 并 导致 定位 误差 不 超过 150m。 严 重 失效 
是 指 造成 了 很 大 的 定位 误差 或 者 接收 器 的 过 载 。 如 果 
一 颗 卫星 经 历 了 导致 严重 失效 的 错误 ， 那 么 在 6h 以 
内 ， 在 地 面 上 大 概 63% 的 地 方 都 将 发 现 这 颗 卫 星 

在 使 用 全 球 定位 系统 进行 准确 定位 时 ， 可 以 控制 
的 因素 包括 : 

1) 在 接收 顺和 卫星 之 间 ， 视 线 不 能 被 阻挡 。 

2) 依赖 于 大 气 层 的 条 件 。 

3) 依赖 于 接收 (59) 射频 信号 的 能 

大 面积 出 现 错误 预测 的 可 能 性 还 是 存在 的 。 总 体 
来 说 ， 当 卫星 位 于 接收 器 的 正 上 方 时 ， 射 频 信号 的 质 
量 要 比 卫星 位 于 接收 器 的 水 平方 向 要 好 。 另 外 ， 因 为 
全 球 定位 系统 的 定位 是 基于 差分 信号 分 析 ， 最 好 的 情 
况 是 用 于 全 球 定位 系统 定位 计算 的 卫星 广泛 的 分 布 于 
A a 


o 


置 精度 衰减 因子 值 。 
全 球 定位 系统 接收 器 的 最 小 化 性 能 指标 的 计算 是 
基于 通过 使 用 来 自 一 个 静止 的 测绘 点 的 线性 化 求解 ， 
将 瞬时 距离 残 差 转 换 为 一 个 用 户 的 定位 预测 而 获得 
的 。 大 部 分 接收 器 使 用 额外 的 技术 ， 例 如 距离 残 差 平 
滑 化 、 速 度 补偿 、 卡 尔 曼 滤 波 或 者 多 卫星 (所 有 可 
视 卫 星 ) 方案 等 。 也 就 是 说 ， 定 位 系统 的 正式 性 能 
是 相对 于 一 个 最 小 值 测量 的 。 全 球 定位 系统 的 定位 预 
测算 法 总 结 如 下 : 

1) 根据 位 置 精度 衰减 因子 计算 最 小 误差 并 以 此 
选择 最 好 的 四 颗 卫 星 。 

2) 每 隔 五 分 钟 ， 或 者 在 所 选 卫 星 运作 时 进行 
更 新 。 

3) 测量 从 接收 器 到 每 颗 卫 星之 间 的 伪 距 。 四 次 
测量 中 的 每 一 次 都 必须 有 一 个 求解 时 间 在 0. 5s 内 的 


二 


全 球 定位 系统 的 信号 处 于 微波 段 ， 因 此 ， 信 和 号 
以 穿 透 塑 料 和 玻璃 ， 但 是 会 被 诸如 水 、 木 和 大 量 树叶 
吸收 ， 并 且 会 被 许多 种 材料 反射 。 其 后果 是 ,在 诸如 
度 密 的 森林 里 、 深 谷中 、 车 船 舰艇 内 部 、 降 雪 量 大 的 
时 候 或 者 高 层 建筑 物 之 间 ， 全 球 定位 系统 不 能 稳定 工 
作 。 在 这 些 情况 下 ， 空 中 的 部 分 阻碍 可 能 不 会 阻碍 定 
位 预测 的 进行 。 假 设 在 轨 运 转 的 卫星 数 至 少 是 24 颗 ， 


接收 时 间 标 签 。 接 收 时 间 标 签 基于 测量 系统 时 间 ， 而 
传输 时 间 标 签 基于 卫星 时 间 。 
4) 决定 每 一 颗 在 使 用 中 的 卫星 的 星 历 表 并 为 每 
一 颗 卫 星 计算 出 位 于 地 固 地 心 直 角 坐标 系 ( ECEF) 
内 的 坐标 。 根 据 地 球 自 转 进 行 校正 并 因此 为 每 一 颗 卫 
星 计算 一 个 伪 距 的 估计 值 。 
5) 计算 距离 残 差 ， 即 实际 距离 和 观测 距离 之 间 


那么 平均 穿越 地 球 表 面 上 空 的 卫星 会 有 8 颗 在 可 视 范 
围 内 ， 这 样 即便 是 出 现 这 种 情况 ， 也 还 是 可 以 容忍 


的 差 。 
6) 估算 决定 整个 系统 解决 方案 的 矩阵 G， 即 定 


"A 


的 。 男 一 方面 ， 空 中 的 部 分 阻碍 可 以 导致 定位 的 准确 


位 解决 方案 几何 矩阵 。 此 和 矩阵 可 以 用 行 向 量 组 描述 ， 


度 下 降 。 这 是 因为 此 时 有 效 卫 星 的 选择 变 少 了 ， 而 最 
优 准 确 度 的 取得 是 基于 尽 可 能 多 的 提供 定位 运算 的 备 
选 卫 星 (以 便 在 接收 器 内 部 的 卡尔 曼 滤 波 器 进行 适 
当 加 权 )。 

进一步 区 分 不 同 的 接收 器 的 性 能 因素 包括 : 采集 


每 个 行 向 量 包含 了 其 中 一 个 被 使 用 卫星 的 x，y，z A^ 
标 和 介 于 接收 器 和 卫星 之 间 的 向 量 的 时 间 坐 标 方 向 余 
弦 。 这 个 向 量 是 位 于 一 个 被 称 为 世界 测 地 系统 
(WGS84) 的 固定 于 地 球 的 参考 坐标 系 。 

7) 计算 接收 器 的 位 置 。 
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标准 的 全 球 定位 系统 的 实施 是 每 一 秒 钟 计 算出 
个 定位 信息 ， 虽 然 更 快 或 者 更 慢 的 频率 也 是 可 行 的 。 
在 典型 的 操作 条 件 下 ， 没 有 进行 任何 特别 性 能 提升 的 
定位 准确 率 大 概 在 水 平方 向 20 ~ 25m 间 ， 垂 直方 向 
43m 左右 。 基 于 美国 海军 观象台 的 参考 信号 每 秒 脉冲 
数 (PPS) 受 限 的 信号 至 少 可 以 提供 水 平方 向 22m 
(典型 值 是 7 ~ 10m) ， 和 垂直 方向 27. 7m 的 准确 性 ， 
以 及 在 200ns 之 内 的 世界 协调 时 间 (UTC)。 

全 球 定位 系统 的 信号 可 能 会 被 多 路 径 问 题 影响 。 
也 就 是 无 线 电信 号 会 在 接收 器 周围 的 地 域 一 一 如 建筑 
物 、 峡 谷 峭壁 和 硬 地 等 发 生 反射 。 反 射 以 后 被 接收 器 
接收 的 信号 会 造成 误差 。 为 了 解决 多 路 径 问 题 ， 研 究 
人 员 研 发 出 来 多 种 有 关 接 收 器 的 科技 ， 其 中 最 有 名 的 
可 能 就 是 狭窄 相关 器 间隔 法 ”1 。 对 于 长 时 延迟 的 
多 路 径 问题 ， 接 收 器 本 身 就 能 辨认 出 延迟 的 信号 并 弃 
之 不 用 。 为 了 解决 由 地 面 反 射 造成 的 短路 径 的 多 路 径 
问题 ， 可 能 就 得 需要 安装 特别 的 天 线 了 。 这 种 短路 径 
形式 的 信号 很 难 被 过 滤 掉 ， 因 为 跟 直 接 广播 到 接收 需 
的 信号 相 比 ， 它 只 是 稍微 延迟 了 一 些 而 已 。 而 它 的 影 
响 与 大 气 层 延迟 造成 的 路 径 波 动 相 比 很 难 区 分 开 。 


增强 型 全 球 定位 系统 


1. 广 域 增强 系统 (WAAS) 

广 域 增 强 系 统 (WAAS) 是 一 种 可 以 被 接收 器 接 
收 的 辅助 信号 ， 用 以 提高 接收 器 的 准确 性 。WAAS 能 
将 单独 使 用 GPS 的 水 平 位 置 准确 度 从 10 ~ 12m 提高 
到 1~2m。WAAS 的 信号 里 面包 含 了 对 GPS 信号 的 一 
些 引 发 误差 的 因素 的 校正 ， 包 括 时 间 误 差 、 卫 星 位 置 
纠正 和 电离 层 变化 引起 的 局 部 扰动 等 。 这 些 校正 信息 
由 方位 固定 并 经 过 精确 定位 的 地 面 基 站 估 测 并 上 传 到 
星 上 以 广播 到 恰当 配置 的 接收 器 。WAAS 信号 只 适 
用 于 北美 地 区 。 但 是 作为 基于 卫星 的 系统 提升 标准 模 
x (SBAS) 的 一 部 分 ， 相 似 的 校正 信号 正 逐 步 在 其 
他 地 方 应 用 开 来 。 这 些 地 方 包括 欧洲 ， 称 为 欧洲 同步 
卫星 导航 覆盖 服务 (EGNOS); 包括 日 本 和 其 他 亚洲 
部 分 地 区 ， 被 称 为 多 功能 卫星 增强 系统 (MSAS). 
以 一 种 称 为 全 球 导 航 卫 星 登 录 系 统 (GLS) 对 GPS 和 
WAAS 的 进一步 提升 ， 预 计 于 2013 年 完成 。 

2. 差分 式 全 球 定位 系统 

差分 式 全 球 定 位 系统 (DGPS) 是 一 种 采用 坐落 
于 一 个 接收 器 周围 的 、 已 经 精确 勘测 位 置 的 地 点 对 
GPS 信和 号 进行 纠正 的 技术 。 事 实 上 ， 基 于 此 基本 概念 
有 几 种 版 本 存在 ， 而 它们 一 般 也 被 称 为 地 基 增 强 系统 
(GBAS), DGPS 使 用 与 WAAS 同样 的 原理 , 但 是 它 
仅 是 一 种 局 部 的 手段 而 没有 借助 于 向 卫星 上 传 数据 的 
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办 法 。 在 已 知 地 点 接收 器 计算 出 GPS 信号 中 的 误差 
并 把 它 传输 给 附近 未 知 方位 的 接收 器 。 因 为 这 种 误差 
因 地 球 上 的 地 点 不 同 而 变化 ， 这 种 纠正 的 有 效 性 随 距 
离 增 加 而 下 降 。 一 般 来 说 ， 最 大 有 效 距 离 为 几 百 英 
里 。 人 们 在 选择 可 用 性 的 中 止 以 及 WAAS (其 可 被 看 
做 一 种 DGPS) 的 开发 以 前 特别 想 要 这 个 纠正 方案 。 
在 美国 和 加 拿 大 ， 一 个 地 基 DGPS 发 射 器 网 络 在 运转 
着 ， 发 射频 率 介 于 285kHz 和 325kHz 的 无 线 电信 号 。 
类 似 于 WAAS 的 商用 DGPS 解决 方案 也 同样 存在 。 

3. 接收 器 自动 完好 监视 (RAIM) 

接收 器 自动 完好 监视 (RAIM) 是 一 种 使 用 不 同 
的 卫星 组 合 来 获取 多 种 伪 距 测量 ( 即 定位 估算 ) 的 
技术 。 如 果 取 得 了 不 一 致 的 测量 ， 它 就 指示 出 系统 某 
部 分 发 生 了 故障 。 一 次 定位 至 少 需要 使 用 五 颗 卫星 以 
检测 到 这 种 故障 ; 而 至 少 需要 六 颗 卫 星 才能 排除 来 自 
单 颗 信号 发 生 故障 的 卫星 的 数据 ， 同 时 仍 能 取得 可 靠 
的 定位 预测 。 


20.5.4 接收 器 及 其 通信 系统 


1. 接收 器 分 类 

全 球 定 位 系统 接收 器 以 性 能 和 造价 区 分 类 别 。 最 
好 的 是 达到 测 地 级 别 的 接收 器 而 经 济 型 的 型 号 则 被 称 
为 有 源 级 或 娱乐 型 接收 器 。 大 体 上 ， 这 些 不 同型 号 接 
收 器 的 造价 会 相差 几 个 数量 级 ， 但 是 它们 的 性 能 差异 
则 在 逐渐 缩小 。 

接收 器 按 原理 分 为 两 个 类 型 : 代码 相位 型 和 载波 
相位 型 。 代 码 相位 型 接收 器 使 用 数据 流 中 卫星 导航 信 
息 的 部 分 来 提供 星 历 表 数 据 并 产生 实时 结果 。 它 们 需 
要 一 段 时 间 以 锁定 卫星 ， 但 不 需要 估 测 初始 位 置 就 可 
以 连续 输出 结果 。C/A 信号 是 一 个 具有 一 个 已 知 密 
钥 的 含有 1023 个 伪 随机 噪声 (PRN) 的 位 串 。 真 正 
的 伪 距 通过 找到 这 个 位 串 的 相位 偏差 决定 。 另 一 方面 
来 说 ， 载 波 相 位 型 接收 器 使 用 的 是 原始 的 GPS 的 信 
号 相位 ， 而 不 是 嵌入 式 的 〈 数 字 ) C/A 信号 。 在 Ll 
Al L2 信道 上 的 信号 分 别 有 19cm 和 25em 的 波长 ， 而 
优质 相位 的 测量 可 以 给 予 水 平方 向 达到 毫米 级 的 准确 
率 。 然 而 ， 这 些 测 量 只 是 提供 一 个 距离 达到 数 十 公里 
的 范围 内 的 相对 定位 信息 。 

2. 串 行 通信 协议 

全 球 各 地 的 全 球 定 位 系统 消费 级 设备 几乎 都 支持 
一 种 称 为 国家 海洋 电子 协会 (NMEA) 的 传输 协议 的 
变 体 。 这 种 协议 通常 是 一 种 通过 RS-232 线路 传输 的 
串 行 通信 协议 。 这 个 协议 具有 几 种 变 体 ， 而 其 中 
NMEA0183 的 变 体 应 用 最 广泛 ， 而 NMEA2000 支持 更 
高 传输 速率 。 尽 管 这 个 协议 为 国家 海洋 电子 协会 独 
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有 ， 其 官方 规范 只 能 从 该 协会 购买 ， 但 是 确实 存在 几 
种 关于 该 协议 的 开源 描述 ， 使 该 协议 被 逆向 开发 。 

该 协议 支持 基于 以 一 个 谈话 者 (GPS BEM ai) 
和 一 个 或 多 个 收听 者 (电脑 ) 的 以 ASCII 代码 通信 模 
式 。 收 听 者 接收 的 是 简单 的 协议 字符 串 ， 称 为 句子 。 
有 传闻 暗示 在 该 协议 中 存在 模棱两可 的 地 方 从 而 导致 
不 能 够 确保 不 同 设备 间 的 兼容 性 (此 暗示 不 是 通过 
对 协议 的 独家 文档 的 检视 而 获得 的 ， 因 而 不 便 在 本 书 


中 讨论 ) 。 


20.6 ”全球 定 位 系统 和 惯 导 的 集成 


尽管 全 球 定 位 系统 承诺 提供 有 关 地 球 表面 的 高 精 
度 的 定位 信息 ， 但 它 并 不 能 解决 关于 机 器 人 姿态 预测 
的 所 有 问题 。 首 先 ， 它 不 能 直接 获得 有 关 交 通 工具 方 
位 角 的 信息 。 为 了 决定 交通 工具 的 航向 角 以 及 许多 交 
通 工具 需要 的 俯仰 角 和 侧 滚 角 ， 必 须 对 GPS 信号 进 
行 差分 或 者 与 其 他 诸如 罗盘 、 旋 转 罗 盘 和 惯 导 之 类 的 
传感器 进行 融合 。 其 次 ，GPS 接收 器 通常 无 法 提供 连 
续 的 、 独 立 的 有 关 位 置 的 预测 ， 而 只 能 提供 在 不 同 的 
时 间 点 的 预测 (至少 对 廉价 接收 器 是 这 样 )， 而 这 种 
测量 的 延迟 相当 大 。 连 续 的 姿态 预测 需要 在 两 个 GPS 
读数 之 间 进 行 。 最 后 ，GPS 的 定位 不 是 一 直 都 可 行 
的 。 当 地 的 地 理 条 件 〈 像 高 山 、 高 楼 和 树 ) 或 接收 
器 上 面 对 无 线 电信 和 号 的 屏蔽 (如 室内 或 水 下 ) 都 会 
将 信号 完全 封锁 。GPS 接收 器 与 男 一 种 传 感 技术 
(常常 是 惯性 传感器 ) 的 集成 至 少 可 以 在 短 时 期 内 解 
决 这 些 问 题 。 

GPS 与 惯性 传感器 的 集成 通常 以 卡尔 曼 滤波 器 的 
形式 进行 (参见 第 23.2.3 节 )。 本 质 上 惯性 传感器 
的 数据 用 以 过 滤 固 定 的 GPS 数据 ， 并 在 两 组 数据 都 
有 效 的 时 候 以 最 小 二 乘法 的 形式 进行 优化 。 鉴 于 此 两 
组 传感器 互补 的 自然 属性 和 完全 独立 性 ， 市 场 上 有 相 
当 多 的 商用 套装 已 经 开发 出 来 用 以 集成 GPS 和 惯性 
传感器 的 数据 ( 例 见 参考 文献 [20. 21])。 


20.7 扩展 阅读 


1. 里 程 仪 

包括 参考 文献 [20.2] 和 参考 文献 [20.22] 在 
内 ， 许 多 关于 机 器 人 技术 的 一 般 介 绍 性 的 书籍 都 提供 
了 相当 多 的 有 关 交 通 工 具 使 用 里 程 仪 的 信息 ， 以 及 使 
用 交通 工具 设计 标准 推导 里 程 仪 的 方程 。 

2. 陀螺 仪 系统 

Everett 3588 53 p BO” 提供 了 包括 陀螺 仪 系统 和 


加 速度 仪 在 内 的 许多 传感器 技术 的 回顾 。 而 有 关 旋 转 
罗盘 及 其 发 明 者 的 有 趣 的 历史 记载 则 可 以 在 Hughes 
的 书 里 找到 1。 

3. 加 速度 仪 

刚刚 提 到 ，Everett 撰写 的 书 ” 引 提供 了 许多 传 
感 器 技术 的 回顾 ， 其 中 就 包括 陀螺 仪 系统 和 加 速 
FEM 

4. 全 球 定位 系统 

相当 多 的 有 关 GPS 系统 的 理论 和 实现 的 详细 资 
料 可 以 在 Leick WPO PRA, AÉ GPS 系统 的 理 
论 知识 和 实现 同样 可 以 参见 参考 文献 [20.25]。 而 
多 种 有 关 GPS 和 惯性 导航 系统 集成 的 详细 材料 可 以 
参阅 参考 文献 [20.26] 和 参考 文献 [20.27]. 


20.8 市 场 上 的 现 有 硬件 


尽管 下 面 所 列 出 来 的 硬件 有 可 能 只 有 短暂 的 上 架 
时 间 ， 这 些 联系 方式 清单 应 该 是 一 个 识别 、 寻 找 特别 
的 惯性 传 感 设 备 的 开始 。 
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呐 感 测 的 物理 原理 ， " 句 机 器 人 技术 应 用 中 的 目标 21. 10. 1 NECNON o ec ara EDA EET 50 
定位 、 地 标 测 量 、 分 类 等 。 说 明 声呐 伪 影 的 来 源 ， 21. 10.2 方位 估计 p IE 50 
以 及 如 何 处 理 它们 根据 主要 突出 特点 ， 概述 了 不 21.11 CTEM 声明 ee 51 
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续 传输 调频 ( CTFM) 系统 ， 并 讨论 噪声 存在 条 件 21. 11. 5 ee ] these e xx ens ev en rns esr d 53 
下 提高 目标 灵敏 度 的 能 a 然后 ， 论述 了 各 种 各 样 21. 12 多 脉冲 声呐 —X— Pr RA 53 
的 声呐 环 设计 结合 测绘 结果 进行 周 CEST 21.12.1 TR ja EE 53 
x. TS 其 灵感 来 自 于 动物 ， 如 蝙 21.12.2 目标 即时 分 类 Bera ERR ber SR DE QNO ae 54 
EORUM AR. 21.13 声呐 环 e mH 54 
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21. 13.2 BEER ee MMHMMMHMMHHHHRR 54 
21.1 声呐 原理 Bae erste nha cawes ieregu Cupid aen 28 i lA ge A IP 55 
21.2 声呐 波束 图 ppp 40 21. 14. 1 平面 的 移动 观测 vee eee ee eee 55 
21.3 声速 HH 42 21.14. 2” 角 的 移动 观测 eee 56 
21.4 波形 42 21.14.3 PAYEE SHY een 56 
21.5 换 能 器 技术 pp 43 21.14 4 接收 角 移 动 观测 的 影响 n 57 
21.5.1 静电 换 能 器 eH 43 21.14.5 平面 、 角 和 边 的 移动 观测 到 
21:5:2- EBM REE enirir ie irio 43 | E 57 
21.5.3 微型 机 电 系统 (MEMS) pp 44^ ais Ee r ae a aa 57 
A ME e eein 44 21.16 MØ eee HH 58 
A s D E HESS 0 ee 58 
21.8 TOF 测 距 HMM 45 
重量 轻 、 低 功 耗 和 低 计 算 量 等 特点 。 在 一 些 如 水 下 
21.1 声呐 原理 和 低 可 见 度 环境 的 应 用 中 ， 声 呐 经 常 是 唯一 可 行 的 
感 测 模 态 。 
声呐 是 机 器 人 技术 中 一 种 很 流行 的 传 感 顺 ， 采 机 器 人 技术 中 声呐 有 三 个 不 同 但 相关 联 的 用 途 : 
用 声 脉冲 及 其 回 波 来 测量 目标 所 在 的 距离 。 由 于 声 1) 避 障 : 第 一 个 探测 到 的 回 波 被 假设 为 最 近 目 
首 的 速度 通常 为 人 所 知 ， 目 标 距离 与 回 波 传播 时 间 。 标 产 生 的 回 波 ， 测 量 其 所 在 的 距离 。 机 器 人 利用 这 个 
成 正比 。 在 超声 波 频 段 中 声呐 能 量 集中 于 一 束 ， 除 ”信息 来 规划 路 径 绕 过 障碍 物 ， 防 止 碰撞 。 
了 距离 之 外 还 提供 方位 信息 。 它 的 普及 性 归功 于 ， 2) 声呐 测绘 : 通过 旋转 扫描 或 声呐 阵列 获得 一 
跟 其 他 测 距 传感器 相 比 ， 声 响 传 感 器 具有 低 成 本 、 — 批 回 波 ， 用 来 创建 环境 地 图 。 类 似 于 雷达 显示 ,测量 
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点 被 放置 在 沿 着 探测 脉冲 方向 的 可 测 范围 内 。 

3) 目标 识别 : 一 系列 回 波 或 声呐 地 图 经 处 理 后 
对 产生 回 波 的 结构 进行 分 类 ， 这 些 结构 包含 一 个 或 多 
个 物理 目标 。 如 果 成 功 的 话 ， 这 种 信息 对 机 器 人 配 准 
或 地 标 导 航 是 有 用 的 。 

图 21. 1 表示 一 个 简化 的 声呐 系统 ， 包 括 从 其 配 
置 到 所 产生 的 声呐 地 图 。 声 呐 传 感 器 ( 记 为 T/R) 
既 充当 探测 声 脉冲 ( 记 为 P) 的 发 射 器 ( 记 为 T)， 
又 作为 回 波 ( 记 为 E) 的 接收 器 。 位 于 声呐 波束 里 的 
目标 0 由 阴影 区 域 表 示 ， 来 反射 探测 脉冲 。 反 射 信 
号 的 一 部 分 返回 至 换 能 器 上 ， 被 检测 为 一 个 回 波 。 回 
波 传播 时 间 如 俗称 为 飞行 时 间 (TOF), ， 是 由 探测 脉 
冲 传输 时 间 测 得 的 。 在 这 种 情况 下 ， 回 波 波形 是 探测 
脉冲 的 副本 ， 通 常 由 多 达 16 个 周期 的 传感器 共振 频 
率 组 成 。 目 标 距离 ro 采用 式 (21.1) 计算 。 

cto 
atta 
式 中 ，e 表示 声速 (在 标准 温度 和 压力 下 声速 为 
343m/s); 因子 2 将 往返 (P+E) 传播 距离 转换 为 单 
程 测量 。 波 束 扩 展 损失 和 声 吸收 限制 了 声呐 距离 。 


(21.1) 


T/R ETUR OE 5 OQ 
E 
a) 
传输 时 间 
» 
to 时 间 
b) 
声呐 位 置 测量 点 
O Do a s ts] 


Omi} 


i8 


ou 


Æ 21.1 声呐 测 距 原理 
a) 声呐 配置 b) 回 波 波 形 
c) 测量 点 位 置 d) 声呐 地 图 


在 形成 的 声呐 地 图 里 ,测量 点 被 放置 在 相应 的 换 
能 器 物理 定位 的 方向 上 。 通 常 声 呐 地 图 通过 旋转 垂直 


离散 的 角度 Ab 分 隔 开 ， 并 在 相应 的 范围 内 放置 声呐 
点 。 由 于 TR 旋转 时 目标 0 到 T/R 中 心 的 距离 几乎 
是 不 变 的 ， 只 要 0 位 于 波束 内 ， 测 量 点 通常 会 落 在 
一 个 圆圈 内 。 因 此 ， 声 呐 地 图 是 由 圆 弧 组 成 的 。 

声呐 的 主要 局 限 性 包括 : 

1) 宽 的 声呐 波束 会 造成 较 差 的 方向 精度 。 目 标 
被 定位 在 孤立 弧 的 中 间 ， 但 较 短 距离 的 目标 缩短 了 较 
远 距 离 目标 的 弧 ， 这 些 由 一 批 目 标 所 产生 的 弧 通 常 很 
难 解释 。 这 种 影响 的 结果 是 宽 波束 阻塞 了 小 孔 ， 限 制 
了 机 器 人 导航 。 

2) 相对 于 光学 传感器 ,缓慢 的 声速 降低 了 声呐 
感 测 速度 。 一 个 新 的 探测 脉冲 应 该 在 来 自 先前 脉冲 的 
所 有 检测 回 波 终止 后 被 发 射 ， 否 则 将 发 生 误 读 ， 如 图 
21.2 Pras, 来 自 探测 脉冲 1 的 回 波 在 探测 脉冲 2 发 
射 后 出 现 。 声 呐 从 最 近 的 探测 脉冲 测量 TOF。 许 多 声 
呐 每 隔 SOms 发 射 探测 脉冲 ， 但 在 混 响 环 境 下 会 遭遇 
误 读 。 


T/R 


a) 
传输 时 间 1 传输 时 间 2 
lo 时 间 
b) 
声呐 位 置 FR 
O: ———————— T 
lo 
c) 


图 21.2 虚假 距离 读数 
a) 声呐 配置 b) 脉冲 1 的 回 波 到 来 之 前 发 射 
的 探测 脉冲 2 c) 从 传输 时 间 2 测 出 的 虚假 距离 


3) 光滑 表面 在 斜 人 射 时 不 产生 可 探测 的 回 波 。 
图 21.3 显示 一 个 平坦 表面 ( 墙 )， 充 当 声 呐 束 的 镜 
子 。 重 点 是 邻近 墙 自身 不 产生 可 探测 的 回 波 ， 使 用 声 
内 避 障 的 机 器 人 可 能 会 与 墙 碰撞 。 

4) 波束 旁 欠 导致 的 伪 影 和 多 次 反射 产生 了 无 目 
标 存在 环境 下 的 距离 读数 。 图 21. 3 也 显示 了 包围 着 
目标 0 的 改变 了 方向 的 波束 。 回 波 也 被 墙 面 改变 方 
向 后 反射 回 换 能 器 。 以 换 能 器 为 参考 ， 目 标 在 虚拟 
物体 位 置 处 VO， 而 且 它 会 产生 相同 的 声呐 地 图 ， 
如 图 21. 1 所 示 。 由 于 没有 物理 目标 对 应 于 声呐 点 


轴线 上 的 传感器 建立 ， 用 方位 角 9 表示， 通过 一 系列 


位 置 ， 因 此 它 是 一 个 伪 影 。 也 要 注意 ,点 虚线 表 


传 感 与 感知 


TREO sc VO 


图 21.3 光滑 表面 在 斜 入 射 时 不 产生 可 探测 的 回 波 


注 : 平面 改变 波束 方向 ， 导 致 在 虚拟 目标 位 置 产 生 声 
内 伪 影 。 点 虚线 表示 的 回 波 路 径 落 到 了 声呐 波束 外 
， 并 不 产生 一 个 可 探测 的 回 波 。 


示 从 换 能 器 反射 回来 的 声学 能 量 ， 并 不 能 被 检测 
到 ， 这 是 因为 它 没有 位 于 波束 锥 形 区 内 。 波 束 旁 
办 通常 检测 这 些 回 波 , 产生 沿 声呐 方位 放置 的 短 
程 读 数 。 

5) 回 波 的 传播 时 间 和 振幅 变化 由 声速 的 不 均一 
性 造成 。 两 种 效应 导致 检测 回 波 传播 时 间 的 随机 波 
动 ， 即 使 在 静态 环境 下 。 图 21. 4 说 明了 热 波动 可 导 
致 加 速 、 延 迟 以 及 回 波折 射 产生 的 传播 改 向 。 这 些 
波动 会 引起 回 波 时 间 和 振幅 变化 ， 以 及 距离 读数 抖 
动 。 虽 然 这 些 波 动 通常 只 引起 声呐 地 图 的 较 小 变化 ， 
但 它们 经 常会 给 更 为 精细 的 分 析 方 法 带 来 巨大 的 
困难 。 


T/R 


传输 时 间 a) 


~ m 
E MM 


b) 时 间 


图 21.4 RNR BH 
a) 声呐 配置 ， 声 音 传播 介质 的 热 不 均匀 性 导致 折射 效应 
b) 静态 环境 下 回 波 的 传播 时 间 和 振幅 变化 举例 


本 前 描 述 了 物理 和 数学 细节 ， 将 简化 的 声呐 模型 
扩展 到 实际 的 声呐 系统 。 


21.2 声呐 波束 图 


为 了 推导 声呐 换 能 器 的 定性 描述 ， 我 们 对 简化 模 
型 运用 基本 声学 理论 得 到 简单 的 解析 式 '" "1 E 
射 器 通常 被 建 模 为 一 个 半径 为 a WARRE, EER 
平面 隔 声 板 上 以 频率 /振动 。 波 长 A 表示 为 
X 
AP, c 是 声音 在 空气 中 的 传播 速度 ，25% 时 为 
343m/s^?!, ? a >A 时 ， 发 射 压力 场 形成 一 个 波 
束 ， 由 一 个 主办 和 环绕 的 若干 旁 淤 组 成 。 在 远 场 ， 或 
者 距离 大 于 a /A 时 ， 波 束 由 它 的 方向 图 描述 ， 方 向 
图 是 孔径 函数 的 二 维 传 里 叶 变换 ， 在 这 种 情况 下 圆 孔 
可 产生 贝 塞 尔 (Bessel) K% TEHBBS r 以 及 与 淤 轴 
线 相关 的 角度 9 下， 发 射 压力 振幅 可 写 为 

ea) qs 

AP, a 是 比例 常数 ,包含 了 空气 密度 和 声 强 ; k= 
2m/A; 几 是 第 一 类 Bessel 函数 ，0 =0， 插 号 项 沿 着 声 
呐 轴 线 求 值 等 于 1; a 项 表示 发 射 压力 ， 随 声呐 办 的 
面积 而 增 大 。 频 率 f 出 现在 分 子 上 ， 这 是 因为 快速 移 
动 的 声呐 办 产生 更 高 的 压力 。 距 离 7 出 现在 分 母 上 ， 
因为 能 量 守 恒定 律 要 求 当 波束 随 距 离 加 宽 时 压力 
减 小 。 

主 斩 由 它 的 第 一 个 离 轴 零 位 定义 ， 出 现在 下 式 
角度 


à= (21.2) 


Pelr,0) =] 


.61A 


)=14.7° (21.4) 


. (0 
0, = avsin( 


例如 ,广泛 采用 的 静电 仪器 级 换 能 器 ， 原 先 由 宝 
丽 来 公司 (Polaroid) 生产 中， 半径 a 等 于 1.8cm， 
日 通常 在 频率 /为 49. 4kHz 下 驱动 ， 此 时 A = 0. 7cm， 
b =14.7。。 
目标 相对 于 和 较 小 ， 且 被 放置 在 发 射 压 力 场 内 ， 
以 球形 波 阵 面 产生 回 波 ， 球 形 波 阵 面 的 振幅 随 传播 距 
离 的 倒数 衰减 。 在 常用 的 脉冲 回 波 单一 换 能 ( 单 静 
AS) 测 距 传感器 中 ， 回 波 阵 面 只 有 部 分 落 到 接收 孔 
径 上 。 如 今 圆 孔 用 作 接 收 器 ， 其 敏感 度 模式 具有 与 
Bessel 函数 相同 的 波束 形状 ， 由 互 易 定理 后 二 给 出 ， 
见 式 〈21.3) 。 如 果 反 射 物 相 对 于 换 能 需 位 于 (>，0) 
处 ， 则 参考 接收 器 输出 ， 检 测 到 的 回 波 压 力 振幅 为 

pides) an 
式 中 , B 是 比例 常数 ， 包 含 了 设计 中 不 可 控 参数 ， 比 
如 空气 密度 。 分 子 中 出 现 附 加 项 2， 是 由 于 大 的 孔 


P,(r,0) 
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径 可 检测 更 多 的 回 波 阵 面 。 

图 21.5 显示 了 来 自 远 场 中 小 (点 状 ) 目标 的 回 
波 振幅 ， 其 作为 静电 仪器 级 换 能 器 探测 到 的 角度 函 
数 。 曲 线 已 被 轴 上 回 波 振幅 归 一 化 。 


归 一 化 回 波 振幅 
1 


0.9 
0.8 
0.7 
0.6 
0.5 
0.4 


图 21.5 角度 函数 的 办 模型 预测 
的 小 目标 回 波 的 归 一 化 振幅 
a) 线性 尺度 b) 分 贝 尺度 


该 模型 是 
的 见解 : 

1) 对 于 与 波长 相关 的 小 反射 体 尺 寸 ， 回 波 振 幅 
随 距 离 平方 的 倒数 而 减 小 ， 因 为 存在 来 自发 射 器 到 目 
标的 L/r 扩散 损失 ， 随 后 又 有 返回 至 接收 器 的 回 波 中 
的 额外 L/r 扩散 损失 。 然 而 ,大 尺寸 反射 体能 够 根据 
惠 更 斯 (Huygens) 原理 进行 处 理 下 和 ， 通 过 将 其 划 
分 为 小 尺寸 反射 体 ， 协 同 增加 它们 的 回 波 贡 献 。 当 在 
二 维 空间 采用 垂直 入 射 增强 的 平面 反射 体 处 理 时 ， 
波 振幅 减 小 了 1/r， 而 不 是 1/r。 柱 面 反 射 体 在 一 维 


定性 的 ， 原因 是 它 提供 了 下 列 实际 有 用 


空间 扩展 ， 导 致 振幅 在 1/r 与 1/ 之 间 变 化 。 更 极端 
的 情况 也 可 能 发 生 在 作为 声音 放大 器 的 凹面 反射 体 
上 ,引起 振幅 随 着 小 于 1 的 距离 的 负 需 减少 。 

2) 正弦 曲线 允 近 激励 的 换 能 器 表现 为 旁 兴 ， 其 
取决 于 由 相位 抵消 造成 的 零 位 。 例 如 ， 常 规 声呐 经 
16 周期 激励 展现 为 劳 闪 。 当 小 反射 体位 于 换 能 器 轴 
上 ， 相 对 于 回 波 振 幅 ， 第 一 个 劳 欠 的 峰值 是 -35dB。 
600 系列 仪器 级 换 能 器 的 说 明 书 指出 第 一 个 离 轴 零 位 
在 15°， 第 一 个 旁 欠 峰值 为 -26dB。 我 们 认为 这 些 测 
量 是 采用 平面 作为 反射 体 进行 的 。 

3) 该 模型 可 用 来 计算 其 他 常规 换 能 器 的 波束 参 
数 近似 值 。 例 如 ， 半 径 为 1.2$cm 的 SensComp 7000 
ABN PE 20° 的 角度 ， 等 于 额定 值 。 然 而 ， 规 定 
的 第 一 个 旁 欠 峰值 大 约 等 于 - 16dB， 这 完全 不 同 于 

35dB 期 望 值 。 

定性 模型 的 局 限 性 包括 : 

1) 现 有 换 能 器 只 是 粗略 估计 声呐 办 在 无 限 平面 
隔 声 板 上 的 振动 ， 无 限 挡 板 指 引 所 有 的 辐射 声 压 进入 
换 能 器 的 前 半空 间 。 现 有 换 能 器 向 四 面 八方 辐射 但 
大 多 数 声 能 集中 于 主办 。 

2) 所 有 脉冲 回 波 测 距 声呐 都 采用 有 限 持续 时 间 
脉冲 ， 而 不 采用 无 限 持续 时 间 的 正弦 脉冲 。 下 面 介绍 
几 个 使 用 脉冲 的 系统 ， 无 论 是 持续 时 间 还 是 形式 ， 这 
些 脉冲 都 完全 不 同 于 正弦 激励 。 一 般 通 过 计算 脉冲 频 
谱 以 及 将 其 分 解 成 若干 个 正弦 频率 对 这 些 脉 冲 进 行 分 
析 ， 每 个 正弦 频率 都 有 自身 的 波束 模式 。 例 如 ， 上 述 
16 周期 脉冲 的 回 波 振幅 预测 是 相当 精确 的 ， 包 括 波 
束 宽度 和 旁 兴 。 但 是 ， 当 使 用 脉冲 或 者 扫 频 激励 时 ， 
净 波 束 剖面 成 为 每 个 激励 频率 成 分 所 产生 的 波束 模式 
的 (线性 振幅 ) 到 加 。 这 样 的 宽带 激励 并 不 表现 为 
零 位 ， 因 为 某 个 频率 形成 的 零 位 可 由 其 他 频率 产生 的 
BOR AY FEF AN SF GSA FE 

3) 大 多 数 声呐 换 能 器 要 被 装 和 人 保护 外 过 中 。 静 
电 仪器 级 换 能 器 盖子 形成 一 个 机 械 过 滤器 ， 可 增强 
49. 4kHz 声音 输出 。 其 他 换 能 器 的 案例 可 能 会 扭曲 发 
射 场 ， 但 大 多 数 换 能 器 产生 某 一 类 型 的 方向 波束 。 

4) 该 模型 不 包括 传播 介质 中 与 频率 相关 的 声 吸 
收 。 这 些 声 吸收 减少 模型 预测 的 回 波 振幅 。 

上 述 分 析 模 型 只 限于 简单 配置 。 随 着 当前 计算 能 
力 的 发 展 ， 换 能 器 能 被 扩展 到 那些 任意 的 、 甚 至 多 重 
的 孔径 ， 具 有 各 种 各 样 的 激励 方式 。 目 标 产 生 的 任意 
形状 的 回 波 波形 可 根据 Huygens FARKE, Ke 
射 器 、 接 收 器 和 目标 表面 被 分 解 为 二 维 表面 阵列 ， 使 
用 尺寸 小 于 AS 的 方 阵 来 发 射 、 反 射 和 探测 组 件 
QE; 尺寸 越 小 越 好 ， 但 要 长 些 ) 。 通 过 假设 脉冲 发 
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射 ， 以 及 沿 着 从 发 射 器 组 件 到 目标 组 件 再 到 接收 器 组 
件 的 所 有 可 能 路 径 释 加 传播 时 间 ， 计 算 给 定 模型 的 肪 
冲 响应 。 时 间 分 辨 率 应 小 于 (04,27, EP a E 
最 大 激励 频率 。 对 于 16 周期 的 49.4kHz 频率 激励 ， 
lus 分 辨 率 就 足够 了 。 更 加 精细 的 分 辨 率 ( <0. Lys) 
是 脉冲 激励 所 必需 的 。 于 是 ， 以 脉冲 响应 与 实际 发 射 
脉冲 波形 的 卷 积 来 计算 回 波 波形 4 。 


21.3 声速 


FRE c 随 大 气温 度 、 压 力 和 湿度 显著 变化 ， 对 确 
定 声呐 系统 的 精度 至 关 重 要 。 本 节 基 于 参考 文献 
[21.6, 7] 概述 了 c 和 这 些 变量 之 间 的 关系 。 


在 海平 面 空气 密度 和 一 个 大 气压 力 下 ， 干 煤 空气 
中 的 声速 表示 为 


cr =20.05 VT +273. 16ms ^! (21.6) 

式 中 ,7 表示 温度 ， 单 位 是 摄氏 度 。 在 大 多 数 情 况 

F, xt (21.6) 可 精确 到 1% 以 内 。 然 而， 既然 相对 

湿度 是 已 知 的， 可 以 做 一 个 更 好 的 估计 如 下 

c, 2 c, +h,[1.0059 x 10 7 

£1. 7776 x10 (T, 17.78)? ]ms!. (21.7) 

对 于 海平 面 大 多 数 气 压 下 ， 温 度 在 - 30 ~ 43°C 范围 

Py, ch (21.7) 可 精确 到 0.1% 以 内 。 既 然 大 气压 p、 
已 知 ， 则 可 以 使 用 下 列表 达 式 


T, +273. 16 
cp =20. 05 Z a ms 
1 -3.79 x 10° (h PaP.) 


(21.8) 
此 处 ， 空 气 饱和 压力 六 ,依赖 于 温度 ， 表 示 如 下 


logio (=) - 1o. 796 E = 全 | -5. 0281log,, (2). 
Po 


1.5047 x10 7^ |1 210 929/71 07700 711] 4 
0.42873 x 102 | 21 + 10% 7990 - 00/0] } 2, 2196 
(21.9) 
式 中 ,pw 是 参考 大 气压 101. 325kPa; T, 是 三 相 点 等 


200 hs 


时 间 


温 温度 ， 其 精确 值 为 273. 16K。 


21.4 波形 
声呐 使 用 各 种 各 样 的 波形 ， 其 中 最 常见 的 类 


型 如 图 21.6 所 示 。 每 个 波形 可 被 认为 是 来 自 垂直 
入 射 面 的 回 波 。 根 据 频谱 带宽 ， 波 形 分 为 窄带 和 
宽带 。 在 加 性 噪声 存在 下 ， 窒 带 脉冲 具有 良好 的 
探测 性 能 ， 而 宽带 脉冲 具备 较 好 的 距离 分 辨 率 ， 
ALA FA 

Al 21.6a 给 出 由 日 本 村 田 公 司 (Murata) 生产 的 
40kHz 压 电 换 能 器 在 8 周期 、40kHz 方 波 (40V...) 
励 下 产生 的 波形 。Murata 传感器 体积 小 、 重 量 轻 、 
率 高 ， 但 是 具有 近似 90° 的 波束 宽度 。 这 些 换 能 器 
用 在 单 站 、 双 站 、 多 站 传感器 阵列 中 号 ”2 。 

接 下 来 的 三 个 波形 都 是 由 Polaroid 600 静电 换 能 
器 产生 的 。 更 小 的 Polaroid 7000 换 能 器 也 可 产生 类 似 
的 波形 。 图 21. 6b 给 出 了 6500 测 距 模块 产生 的 波形 。 
此 测 距 模块 具有 10m 测 距 能 力 、 低 成 本 和 简单 的 数 
字 界 面 ， 是 实施 声呐 阵列 和 声呐 环 的 一 个 受 欢迎 的 选 
择 。 静 电 换 能 器 本 来 是 宽带 的 ， 使 用 频率 范围 为 10 ~ 
I120kHz^*"!, ， 而 罕 带 脉冲 是 通过 在 16 周期 、49. 4kHz 
频率 下 激励 换 能 器 产生 的 。 图 21. 6c 说 明了 一 个 使 用 
Polaroid 静电 换 能 器 宽带 的 方法 ， 以 降 频 方 波 来 激励 
换 能 器 。 这 样 的 扫 频 脉冲 经 带 通 滤波 器 组 处 理 ， 以 提 
取出 依赖 于 反射 体 的 频率 。 相 关 检 测 器 ， 也 称 为 匹 
配 滤波 器 ， 压 缩 扫 频 脉冲 来 提高 距离 分 辨 率 。 长 持 
续 时 间 (100ms) 脉冲 用 于 CTFM 系统 。 图 21. 6d 
显示 了 以 10us 持续 时 间 、300V 电压 脉冲 激励 的 宽 
带 脉冲 。 金 属 防 护 网 格 也 可 作为 以 50kHz 频率 共振 
的 机 械 过 滤器 ， 通 过 机 加 工 去 除 ， 以 获得 范围 为 10 ~ 
120kHz 的 可 用 带宽 ， 峰 值 为 60kHz。 这 样 的 宽带 脉冲 
对 目标 识别 是 有 用 的 "1 。 这 些 脉冲 振幅 小 ， 将 
其 距离 限制 到 lm 或 者 更 少 。 


2 EE 


320 us 


时 间 


b) 


图 21.6 常规 声呐 脉冲 波形 


a) Murata 的 40kHz 换 能 ( qu 


— 


b) Polaroid 600 静电 换 能 器 ， 采 用 16 周期 49. 4kHz 正弦 波 激 励 (6500 测 距 模块 一 罕 带 ) 
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时 间 


40 hs 


时 间 


d) 


图 21.6 常规 声呐 脉冲 波形 ( 续 ) 


c) Polariod 600 静电 换 能 器 ， 采 月 


有 降 频 激发 信号 激励 (宽带) 


d) Polariod 600 静电 换 能 器 ， 采 用 10hs 持续 时 间 、300V 电压 脉冲 激励 ( 宽带 ) 


21.5 换 能 器 技术 


静电 换 能 器 和 压 电 换 能 器 是 可 用 于 空气 中 的 两 种 
主要 类 型 ， 大 体 上 上 既 作为 发 射 器 又 作为 接收 器 ， 图 
21.7 给 出 了 一 些 例子 。 一 般 来 说 ， 静 电 装 置 有 较 高 
的 灵敏 度 和 带宽 ， 但 通常 需要 超过 100V 的 偏 置 电 
压 。 压 电 装 置 工作 在 较 低 电压 ， 使 其 电子 接口 变 得 简 
单 ， 但 具有 高 0 值 共 振 陶瓷 晶体 ， 这 导致 相 较 于 静 
电 换 能 器 ， 它 们 具有 冠 的 频率 响应 。 


4 


图 21.7 从 左 到 右 : 9000 系列 、 仪 器 级 、7000 系列 换 
能 器 的 正视 图 和 后 视图 (照片 由 Boulder 旗下 Ac- 


roname 公司 提供 ， 网 址 为 www. acroname. com ) 


21.5.1 静电 换 能 


个 静电 传感器 例子 是 Polaroid 仪器 级 换 能 
(现在 可 从 SensComp. com 网 址 获取 ) ， 它 是 由 外 面 镀 
金 的 塑料 稍 膜 横 跨 在 一 个 带 圆 形 止 模 的 铝 制 背 板 上 构 
造 而 成 的 。 通 过 向 背 板 施加 150 V 偏 置 电压 对 导电 
销 充电 。 引 入 的 声波 使 金属 薄片 振动 ， 改 变 金属 薄 


片 与 背 板 之 间 的 平均 距离 ， 从 而 改变 金属 薄片 的 电 
Ro BREH qg 是 常量 ， 产 生 的 电压 v(1) 与 不 断 变 
化 的 电容 C(t) REE, Bolt) =gC(1)。 作 为 一 个 
发 射 缮 ， 换 能 带 隔 膜 的 振动 是 对 电容 施加 0 ~300V 
脉冲 引起 的 ,一 般 是 采用 脉冲 变压器 。 对 电容 施加 
300V 电压 产生 的 电荷 造成 隔膜 与 背 板 之 间 的 静电 引 
力 。 背 板 上 的 四 槽 允许 隔膜 伸展 ， 通 过 引起 背 板 粗 
糙 度 的 随机 性 ， 在 频率 响应 中 可 以 获得 一 个 宽 的 共 
振 。 例 如 ，Polaroid 7000 系列 换 能 器 的 带宽 是 
20kHz。 前 置 格 栅 安 装 在 换 能 器 上 ， 移 除 这 个 格 机 
可 减少 格 栅 与 隔膜 之 间 的 损失 和 混 响 。 男 一 个 静电 
换 能 器 是 由 Kay 设 计 的 ,详细 设计 细节 可 参见 参考 
文献 [21.12], 


21.5.2 ERABE 


压 电 陶瓷 换 能 器 可 用 来 作为 发 射 器 和 接收 器 ， 但 
一 些 厂商 分 别 出 售 发 射 器 和 接收 器 ， 以 便 优化 发 射 功 
率 和 接收 器 的 灵敏 度 。 当 电压 施加 在 晶体 上 时 ， 压 电 
共振 晶体 产生 机 械 振动 ， 反 之 当 唱 体 机 械 振动 时 也 会 
产生 电压 。 通 常 圆锥 形 凹 角 被 安装 到 晶体 上 ， 以 便 从 
声学 上 匹配 晶体 在 空气 中 的 声 阻 抗 。 例 如 ，Murata 
MA40ASR/S 接收 和 发 射 换 能 器 工作 于 40kHz。 该 装 
置 直径 为 16mm， 发 射 器 波束 角 为 60。， 相 较 于 最 大 
灵敏 度 接收 器 损耗 为 -20dB。 发 射 器 和 接收 器 的 有 效 
带宽 只 有 几 千 赫兹 ， 归 因 于 晶体 的 共振 特性 。 这 限制 
了 脉冲 的 包 络 上 升 时 间 在 0. 5ms 左右 。 一 个 优势 就 是 
用 低 电 压 驱 动 压 电 装 置 的 能 力 ， 例 如 将 每 个 终端 连接 
到 互补 金属 氧化 物 半 导体 (CMOS) 逻辑 输出 。 压 电 
换 能 器 的 共振 频率 有 较 宽 的 范围 ， 可 从 20kHz 到 兆赫 。 
Murata 还 提供 命名 为 极 化 氟 聚 合 物 一 一 聚 偏 所 乙烯 
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(PVDF) 的 压 电 薄膜 ， 可 参考 网 址 www. msiusa. com, 
该 柔韧 性 薄膜 能 被 切割 成 超声 波 发 射 器 和 接收 器 定制 
所 需 的 任意 形状 和 样式 。 采 用 PVDF 制造 的 发 射 器 和 
接收 器 的 灵敏 度 通常 低 于 陶 次 晶体 换 能 器 ， 大 多 数 应 
用 是 短 距 离 的 ，PVDF 的 宽带 性 质 允许 产生 短 脉冲 ， 
脉冲 回 波 测 距 也 只 有 30mm, 


21.5.3 ”微型 机 电 系 统 (MEMS) 


微型 机 电 系 统 (MEMS) 超声 波 传感器 被 制作 在 
一 个 硅 世 片上 ， 并 与 电子 设备 集成 在 一 起 。 低 成 本 、 
大 量 生产 的 传感器 可 作为 标准 换 能 器 的 替代 物 。 
MEMS 超声 波 换 能 器 可 像 静电 容 换 能 器 一 样 操作 ， 其 
隔膜 由 薄 氮 化 物 制 成 。 装 置 的 工作 频率 可 达 几 兆赫 
效 ， 并 提供 比 压 电 装置 更 好 的 信 噪 比 优 势 ， 这 是 由 于 
它们 能 更 好 匹配 空气 声 阻抗 六 2 。 二 维 阵列 装置 可 
以 装配 到 芯片 上 ， 这 样 更 相配 和 可 控 。 


21.6 反射 物体 模型 


反射 过 程 建 模 有 助 于 解释 回 波 信 息 。 本 闻 考 虑 三 
个 简单 的 反射 体 模型 : 平面 、 角 和 边 ， 如 图 21.8 所 
示 。 这 些 模型 适用 于 单一 换 能 融和 阵列 。 

平面 是 光滑 的 表面 ， 可 用 作 声 学 反射 镜 。 光 滑 
的 墙壁 和 门 的 表面 起 到 平面 反射 镜 的 作用 。 平 面 必 
须 足 够 宽 以 产生 两 种 反射 ， 反 射 路 径 用 虚线 表示 。 
平面 反射 体 只 比 无 限 延 展 平面 的 束 截面 积 稍微 大 一 
些 。 由 于 较 小 的 反射 面 以 及 从 平面 边缘 衍射 的 回 波 
负 干 扰 ， 较 小 的 平面 产生 较 弱 的 回流 。 声 反射 镜 允 
许 使 用 虚拟 换 能 需 进 行 分 析 ， 图 中 用 灰色 阴影 线 
表示 。 


角 是 两 个 表面 
的 侧 边 、 门 侧 板 形 


反射 体 。 角 及 其 三 维 (3-D) 对 应 物 


特性 是 ， 波 从 源头 
为 角 的 两 个 表面 各 
的 一 个 平面 反射 换 
器 ， 可 获得 虚拟 换 


的 止 直角 交会 。 交 叉 墙壁 、 文 件 柜 
成 的 角 通 常 都 被 视 为 室内 环境 的 角 
角楼 镜 的 新 
头 相 同方 向 反射 回来 。 这 是 由 定义 
自 的 平面 反射 造成 的 。 通 过 先 在 角 


能 器 ， 然 后 在 另 一 个 平面 反射 换 能 
能 器 。 这 导致 了 反射 穿 过 角 的 交叉 
点 ， 如 图 21. 8b 所 示 。 虚 拟 换 能 
于 单 站 声呐 ， 来 自 平面 和 角 的 回 波 是 相同 的 ， 平 面 和 


分 析 结 果 表明 ， 对 


角 也 能 产生 相同 的 声呐 地 图 !”。 虚 拟 换 能 器 对 平面 
与 角 的 定位 差别 是 利用 传感器 阵 列 区 分 这 些 反 射 体 来 


yug (2! 11,14] ` 


图 21. 8c 所 示 的 边 模 仿 了 诸如 凸 拐角 、 高 曲率 表 
面 的 物理 对 象 ， 反 射 点 几乎 不 依赖 于 换 能 器 的 位 置 。 
在 走廊 中 随处 可 遇 到 边 。 平 面 和 角 反 射 体 产生 强烈 回 


c) 
图 21.8 反射 体 模型 
a) 平面 b) c) 边 


波 ， 而 边 反 射 体 只 产生 弱 的 回 波 ， 只 能 在 短 距 离 内 被 
Js 7*7 ， 这 使 得 它们 成 为 难以 探测 的 对 象 。 早 期 
机 器 人 声呐 研究 人 员 将 泡沫 包装 材料 放 到 边 的 表面 ， 
以 便 让 它们 被 可 靠 地 探测 到 。 

许多 环境 对 象 可 以 形成 集 平面 、 角 和 边 为 一 体 的 
物理 对 象 。 回 波 产 生 的 模型 259 表明， 垂直 入 射 
面 斑点 和 表面 函数 中 尖 头 改变 的 位 置 及 其 衍生 物 都 能 
产生 回 波 。 具 有 粗糙 表面 的 物体 或 者 多 物体 集合 可 产 
生 各 种 各 样 的 距离 和 方位 ， 如 图 21.9 所 示 。 如 果 
P(t) 表示 单 一 回 波 波 形 ， 通 常 是 探测 波形 的 副本 ， 总 
回 波 波 形 p, (1). 是 NN 个 垂直 入 射 斑 点 产生 的 单独 回 
JE p,(:) 的 总 和 ， 和 人 入 射 点 距离 是 7,， 方位 是 9,， 以 振 
幅 a 进行 缩放 ， 即 


m) = Y con (ee) (21.10) 


RP, a(0) 是 与 表面 斑点 大 小 和 波束 方位 有 关 的 
振幅 因子 。 宽 带 回 波 更 加 复杂 ， 因 为 它们 的 波形 由 于 
衍射 而 以 一 种 确定 的 方式 变化 "1。 

声呐 采用 模拟 /数字 转换 器 获得 波形 样本 以 分 析 
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pi C0) Ph | ESSE PY BE oP FF B5] Ist SERRE je, TT 77 AE DA 
立 的 斑点 各 5 ， 但 更 常见 的 是 ， 增 加 的 传播 时 间 比 
脉冲 持续 时 间 少 ， 从 而 导致 脉冲 重 肆 。 粗 糙 表 面 和 大 
散射 体 ， 如 室内 宽 叶 植物 ， 有 较 大 的 N, RY po CO 
被 当做 随机 过 程 ， S], FE BE TOF 声呐 第 一 次 输出 
Bf, p(t) HET 。 


T/R 


图 21.9 任意 反射 体 模 型 
( 回 波 从 波束 内 垂直 和 人 射 截面 反射 回来 ) 


21.7 f5E 


通常 声呐 在 简单 环境 下 工作 良好 ， 而 复杂 环境 往 
往 产 生 不 可 思议 的 读数 、 伪 影 ， 阻 碍 构建 可 靠 的 声呐 
地 图 。 伪 影 带 给 声呐 一 个 坏 名 声 ， 即 嗜 杂 的 、 或 低 质 
量 的 感 测 模 态 。 声 呐 坚 定 者 认为 声呐 将 会 开辟 许多 新 
的 应 用 ， 只 要 我 们 以 近似 蝙蝠 和 海豚 使 用 回 波 的 水 平 
来 理解 回 波 ”1。 根 据 他 们 如 何 看 待 伪 影 ， 将 声呐 
坚定 者 分 为 两 类 。 第 一 类 试图 构造 智能 传感器 ， 在 数 
据 传送 给 高 级 推理 程序 之 前 识别 并 抑制 伪 影 。 已 往 的 
方法 ”需要 特制 的 电子 设备 ， 由 于 费用 昂贵 或 
缺乏 经 验 ， 其 他 研究 人 员 一 直 不 愿意 采用 这 些 电子 设 
备 。 一 个 替代 方法 是 以 新 颖 的 方式 控制 传统 声响 ， 只 
需要 更 改 软件 就 可 以 产生 一 系列 尖 脉 冲 ” 。 声 呐 
阵列 已 被 用 来 发 现 相 容 数据 ””” 。 镜 反射 体 产 生 
的 回流， 如 平面 、 角 或 柱状 物 ， 显 示 出 被 伪 影 模糊 化 
的 可 探测 特征 。 
第 二 类 声呐 使 用 者 采用 高 级 后 处 理 方法 ,试图 消 
除 常 规 传 感 带 产生 的 伪 影 。 这 些 包 括 (确定 性 ) M) 
格 法 的 支持 者 ”2 ， 包 括 那些 使 用 简化 物理 模型 
的 支持 者 ， 如 声呐 弧 ”””。 在 简单 环境 中 ， 后 处 
理 通 常 消除 伪 影 这些 伪 影 与 特征 ”或 物理 地 图 
不 一 致 ”””。 更 加 复杂 的 伪 影 处 理 方法 是 将 伪 影 看 
做 噪声 ， 并 采用 隐 马 尔 可 夫 模 型 (HMM) PISA 
而 ,需要 多 次 操作 才能 成 功 教会 系统 认 知 相对 简单 的 
环境 ， 主 要 因为 伪 影 不 可 以 作为 独立 的 加 性 噪声 。 消 
除 令 人 烦恼 的 伪 影 可 用 更 为 简单 的 马尔 可 夫 
550 99U AR HMM， 以 单一 通道 获得 充足 的 声呐 数 


nd 


据 。 令 第 二 类 使 用 者 感到 挫败 、 却 让 第 一 类 使 用 者 略 
微 感 到 愉快 的 是 ， 这 种 后 处 理 方 法 在 简单 环境 很 有 
效 ， 但 在 现实 环境 中 却 不 成 功 。 第 二 类 使 用 者 最 终 放 
弃 了 声呐 ， 加 入 到 摄像 机 和 激光 测 距 的 队伍 中 。 

有 两 类 重要 的 伪 影 : 轴 向 多 反射 (MR) 伪 影 和 
动态 伪 影 。 当 它们 表示 某 个 位 置 存在 静态 目标 而 实际 
上 并 不 存在 时 ， 这 些 伪 影 对 声呐 测绘 很 重要 。 令 人 讨 
厌 的 MR 伪 影 是 由 延迟 回 波 造成 的 ， 而 延迟 回 波 是 在 
当前 探测 脉冲 发 出 后 ， 先 前 的 探测 脉冲 超过 检测 门限 
产生 的 。 于 是 这 样 的 伪 影 在 常规 声呐 中 以 近 距 离 目 标 
出 现 ， 合 真实 的 远 距 离 目标 变 得 不 明显 。 大 多 数 声呐 
采用 大 于 50ms 的 探测 脉冲 发 射 周期 以 避免 MR 伪 影 ， 
尽管 有 些 混 响 环境 仍 能 产生 伪 影 |。 
动态 伪 影 是 由 移动 物体 产生 的 ， 比 如 个 人 穿越 声 
呐 波束 。 即 使 这 些 都 是 真实 的 物体 ， 回 波 表 示 它 们 的 
真正 距离 ， 它 们 的 存在 也 不 应 该 作为 描绘 静态 环境 的 
声呐 地 图 的 一 部 分 。 这 样 的 动态 伪 影 使 得 已 存储 的 声 
呐 地 图 与 实际 产生 的 声呐 地 图 之 间 的 定量 匹配 容易 
出 错 。 

另 一 个 普通 伪 影 是 非 轴 向 MR £987, REA 
射 光滑 表面 产生 ， 该 表面 改变 声呐 波束 方向 到 其 他 一 
些 产生 回 波 的 物体 。TOF 产生 沿 着 声呐 轴 放 置 的 距离 
读数 。 虽 然 目 标 没有 出 现在 声呐 地 图 所 指示 的 位 置 ， 
但 是 目标 在 声呐 地 图 的 位 置 是 稳定 的 元 素 ， 能 对 导航 
有 


有 人 可 能 会 认为 ， 如 果 所 有 目标 的 位 置 是 已 知 
的 ， 则 回 波 可 以 被 确定 ， 那么 回 波 不 应 视 为 随机 过 
程 。 然 而 ， 介 质 中 热 梯 度 和 始终 存在 的 电子 噪声 引起 
速度 波动 ， 这 导致 门限 超出 次 数 的 随机 波动 。 甚 至 静 
态 环境 中 的 固定 声呐 也 表现 出 随机 波动 ”i ， 类 似 
于 观测 超过 受热 面 物体 时 出 现 的 视觉 衰减 体验 。 
通过 应 用 三 个 物理 标准 声呐 可 识别 伪 影 R BR 
态 环境 目标 的 回 波 满足 这 些 标准 。 伪 影 特征 包括 一” : 
1) 回 波 振 幅 一 一 回 波 振幅 小 于 某 一 特定 门 
限 值 。 
2) 相干 性 一 一 回 波形 成 恒定 范围 的 方位 角 间 隔 
小 于 某 一 特定 门限 值 。 
3) 一 致 性 一 一 用 声呐 阵列 在 不 同时 间 探 测 到 的 
回流 (缺乏 时 间 相干 性 ) 或 者 对 应 不 同位 置 的 回 波 
(缺乏 空间 相干 性 ) 。 


21.8 TOF WH 


大 多 数 传统 声呐 采用 与 Polareid 600 系列 静电 超 
声波 换 能 器 连接 的 Polaroid 6500 W PEPE? 3z 
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模块 由 两 个 输入 线 上 的 数字 信和 号 控制 (其 中 INIT 用 
于 初始 化 和 探测 脉冲 传输 ，BLNK 用 于 清除 指示 和 复 
位 探测 器 ) ，TOF 读数 出 现在 输出 线 (ECHO) 上 。 
INIT 的 逻辑 转换 引起 换 能 器 发 射 脉冲 ， 在 49. 4kHz 
频率 下 持续 16 个 周期 。 同 一 换 能 器 在 短暂 延迟 后 检 
测 回流， 允许 传输 暂 态 衰 减 。 男 一 个 询问 脉冲 通常 只 
在 先前 脉冲 产生 的 所 有 回 波 衰减 到 低 于 检测 门限 之 后 
才 被 发 射 。 

该 模块 通过 整流 和 有 损 积 分 来 处 理 回 波 。 图 
21. 10 给 出 了 用 于 门限 检测 器 的 处 理 波形 仿真 。 当 发 
射 后 回 波 在 时 间 2, SUGARY, ECHO 在 测 得 的 TOF 时间 
表现 为 一 个 跃迁 ， 即 处 理 后 的 回 波 信 号 第 一 次 超过 
WUT TER c 的 时 间 。 按 照 惯例 ， 反 射 物体 的 距离 7 可 
由 式 (21.11) 计算 。 


= 


ES = 


(21.11) 


st, 表示 声音 在 空气 中 的 速度 ， 通 常 取 为 343m/s。 


10 tm a) 时 间 


to Ím b) 时 间 


图 21. 10 Polaroid 测 距 模块 操作 过 程 仿真 
a) 处 理 后 的 回 波 波形 
b) 门限 交叉 点 周围 延长 的 时 间 和 振幅 尺度 


图 21. 10b 显示 了 门限 检测 点 的 详细 情况 ， 包 括 
全 波 整 流 和 积分 后 残留 的 高 频 波 纹 。 可 注意 到 两 个 影 
W: 第 一 ,总 总 是 出 现在 加 之后， 使 得 门限 检测 成 为 
真实 回 波 到 达 时 间 的 有 偏 估计 。 而 且 ， 这 个 偏差 与 回 
波 振幅 有 关 ， 即 较 强 的 回 波 产 生 具 有 较 大 斜坡 的 积 4 
输出 ， 比 4 早 了 7T。 第 二 ， 当 回 波 振 幅 减 小 时 ， 例 如 
当 目 标 离开 换 能 器 轴 ， 门 限 值 随后 出 现在 积分 输出 中 ， 
六 将 经 历 小 的 跳动 ， 最 后 近似 等 于 半 周 期 全 3 。 

检测 过 程 模型 设计 的 第 一 步 是 建立 与 方位 函数 有 
关 的 回 波 振幅 模型 。Polaroid 换 能 器 通常 被 模型 化 为 
振动 淮 ， 来 产生 发 射 器 /接收 器 波束 图 ， 如 图 21.11 


所 示 。 为 了 简化 分 析 ， 波 束 训 面 峰值 可 用 高 斯 函数 近 
似 表示 ， 即 图 21. 11 中 以 对 数 为 单位 表示 的 抛物 线 ， 
根据 目标 方位 角 9 确定 回 波 振幅 ， 即 

A, = Ayexp( es) 


式 中 ,4 是 轴 上 振幅 ; o 是 测量 的 波束 宽度 。o 取 
5.25° 时 与 波束 图 峰值 很 符合 。 高 斯 模型 仅仅 对 产生 


(21. 12) 


探测 回 波 的 主办 中 央 部 分 是 合理 的 。 
回 波 振幅 /dB 


15 


20 25 
H/C) 
Æ| 21.11 Polaroid 600 系列 换 能 器 的 发 射 器 /接收 器 波束 图 


办 模型 (SD 等 于 5. 25" 的 高 斯 逼近 用 虚线 表示 ，L. 5m JE 
离 内 平面 、 柱 和 杆 状 物体 的 等 效 门限 值 用 点 虚线 表示 ) 


我 们 假定 回 波 到 达 时 间 不随 换 能 器 方向 〈 目标 
方位 ) 明显 变化 ， 这 个 影响 已 被 调查 分 析 且 发 现 很 
小 。 相 反 ， 图 21. 12 中 用 上 和 心 表 示 测 量 的 TOF fü, 
依赖 于 振幅 ， 并 与 影响 回 波 振幅 的 目标 方位 有 关 ， 如 
图 21. 11 所 示 。 
振幅 


Aolt-To) 


to tm t m 时 间 


图 21. 12 理想 化 处 理 后 的 有 两 个 振幅 的 回 波 波形 
所 对 应 的 TOF fle, Ale! C 实 线 表示 大 振幅 回 波 ) 


该 模块 处 理 检测 回 波 波形 是 通过 上 述 整流 和 有 损 
积分 实现 的 。 为 了 获得 有 用 的 分 析 模 型 ， 要 假设 积分 
是 无 损 的 ， 整 流 后 的 波形 是 幅 值 为 4 BU RD BST BR PRI 
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数 。 图 21. 10b 给 出 了 线性 函数 在 时 间 总 左右 逼近 处 
理 后 的 波形 ， 如 图 21. 12 所 示 。 当 有 损 整 流 接近 恒定 
值 时 ， 该 模型 忽视 波形 的 残余 波纹 和 下 降 和 斜率 ， 如 图 
21.10 所 示 。 和 斜率 与 回 波 振幅 成 正比 的 线性 函数 定义 
HA (t—ty), i 三 。 该 函数 在 时 间 1 超过 门限 7， 


2 
ta =ty 4 n Siya ` ev(25:) (21.13) 
0 0 


对 于 国定 的 z,， 所 中 增加 的 延迟 是 方位 角 0 的 函数 ， 
回 波 振幅 成 反比 。 当 恒定 的 回 波 振幅 4 (V) 应 用 
积分 器 时 ， 线 性 输出 的 斜率 是 4(V《s) ， 典 型 值 近似 
为 4,=10 ;V/s。 当 T=0.10V, 则 T/A4, =10-5s=1us。 

参考 文献 [21.38] 采用 连接 到 6500 型 测 距 模块 
的 Polaroid 600 系列 换 能 器 进行 了 实验 。 当 进行 旋转 
扫描 时 ，Polaroid 模块 按照 常规 操作 来 产生 总 值 。 所 
有 物体 都 位 于 1. 5m 距离 内 ， 包 括 宽 为 1m BOE TR 
直径 为 8. 9cm 的 柱 以 及 直径 为 8mm 的 杆 。 从 - 40238 
+40° 每 步 0.3° 执 行 旋转 扫描 。 在 每 个 角度 记录 下 
100i,, 值 。 当 目标 位 于 声呐 轴 上 (9=0) HF, 确定， 
的 均 差 ,并 计算 出 标准 方差 (SD) 值 。 没 有 其 他 目 
标 接近 于 被 扫描 的 对 象 。2m 外 的 目标 产生 的 回 波 可 
用 距离 选 通 消除 。 

图 21. 13a 给 出 平面 体 的 数据 ， 图 21. 13b 显示 了 
柱状 体 的 数据 ， 图 21. 13c 是 杆 状 体 的 数据 。 可 以 看 
出 ， 这 些 值 与 0" 方 位 角 观 测 到 的 总 值 有 关 。 虚 线 表 
示 该 模型 的 预测 值 。s, 数值 表明 了 在 0° 方位 角 上 SD 
等 于 5ps (0.9mm) 的 变化 ， 这 比 单独 采样 抖动 预测 
得 到 的 值 大 将 近 9 倍 。 随 机 的 时 间 抖 动 是 由 空气 传播 
介质 的 动态 热 不 均一 性 造成 的 ， 这 可 改变 局 部 声速 ， 
并 引起 折射 。SD 随 着 零 方位 偏差 而 增加 ， 因 为 较 小 
的 回 波 在 处 理 过 的 波形 之 后 超过 门限 。 处 理 回 波 波形 
后 半 部 分 的 较 小 斜率 如 图 21.10 所 示 ， 导 致 对 于 给 定 
的 回 波 振 幅 变 化 ,i 出现 较 大 差异 ， 从 而 需要 增 
大 SD。 

非 该 模型 描述 的 一 个 数据 特征 是 ， 由 于 积分 器 输 
出 的 残余 波纹 ， 导 致 TOF 读数 的 跳动 ， 这 些 跳动 等 
TX (21.13) 得 出 的 预测 值 再 加 上 半 周 期 (10ps) 。 
在 图 21. 13 所 示 的 均值 中 ， 这 些 跳 动 是 明显 的 。 

检测 回 波 的 角度 范围 是 平面 为 44"， 柱 状 体 为 
22. 8" ， 杆 状 体 为 18.6°。 平 面体 产生 的 劳 办 是 可 见 
的 ， 具有 小 的 回 波 振幅 ， 这 导致 它们 的 i, 值 在 时 间 上 
变化 缓慢 。 这 些 角 度 范围 与 回 波 振幅 有 关 ， 根 据 瓣 模 
型 回 波 振幅 将 产生 各 自 的 弧 ， 如 图 21. 11 所 示 。 对 于 
平面 体 ， 与 最 大 回 波 振幅 有 关 的 门限 值 是 -38dB， 
柱状 体 的 门限 值 是 -25dB， 杆 状 体 的 门限 值 是 
-13dB。 因 为 每 个 目标 在 1. 5m 距离 内 的 测 距 模 块 门 


dm 


U 


时 间 /hs 
150 


20 30 
方位 /(9) 
a) 
时 间 /hs 
150 


20 30 
方位 /(o) 
时 间 /hs 
150 


-30 -20 -10 0 10 
9) 


20 30 
方位 /(9) 


图 21.13 来 自 1.5m 上 距离 内 目标 的 TOF 数据 
(100 个 测量 值 取 平均 ， 柱 状 条 表示 +1 SD, 
虚线 表示 模型 预测 值 ) 

a) Im 宽 的 平面 体 (Z4 =0. 15hs) 
b) 8. 9cm 直径 的 柱状 体 (T/4 =0. 67 ps) 
径 的 杆 状 体 (T/A =2. 68 us) 


c) 8mm 
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限 是 相同 的 ， 所 以 门限 值 差 异 表 明了 来 自 每 个 目标 的 
相对 回 波 强度 ， 即 平面 体 回 波 比 柱状 体 回 波 大 13dB 
(4.5 fi) ， 而 柱状 体 回 波 比 杆 状 体 回 波 大 12dB (4 倍 ) 。 


21.9 回声 波形 编码 


第 一 个 回 波 之 后 的 回 波 信息 显示 系统 已 经 得 到 研 
究 呈 0222， 但 一 般 使 用 常规 电子 设备 。 检 查 整 
个 回 波 波形 的 动机 之 一 是 采用 该 方法 的 医学 诊断 超声 
BURAK MMA 。 
作为 模拟 /数字 转换 较为 经 济 的 选择 ，Polaroid W 
距 模块 通过 不 断 重 置 检测 电路 来 探测 起 始 回 波 之 后 的 
回 波 。6500 模块 说 明 书 指出 ， 复 位 之 前 要 延 时 以 防 
上 当前 回 波 重新 触发 检测 电路 二 3 。 让 我 们 忽略 这 个 
建议 ， 以 非 标准 方式 控制 Polaroid 模块 来 提供 整个 回 
波 的 信息 。 自 从 Polaroid 模块 产生 的 数字 输出 中 估计 
出 回 波 振幅 后 ， 这 个 操作 过 程 就 被 称 为 伪 振 幅 扫 描 
(PAS) FEINES] 
传统 测 距 模块 采用 整流 和 有 损 积 分 来 处 理 检 测 回 
波 ， 如 图 21. 14a 所 示 。 


= 


440 us 


ia) : 时 间 


i) 时 间 


图 21. 14 Polaroid 测 距 模块 工作 模式 
a) 处 理 后 的 回 波 波形 b) 常规 飞行 时 间 模 式 
下 ECHO 输出 c) PAS 模式 下 ECHO 输出 


BLNK 输入 一 般 保持 在 零 逻 辑 电 平 ， 使 ECHO fr 
出 。 当 处 理 后 的 回 波 信号 超过 门限 时 ，ECHO 表现 为 
一 个 跃迁， 如 图 21. 14b 所 示 。 按 照 惯 例 ，INIT 和 
ECHO 转换 之 间 的 时 间 间 隔 表 示 为 飞行 时 间 (TOF), 
反射 物体 的 距离 + 计算 如 下 


ox TOF 
“2 


(21.14) 


通过 脉冲 调制 BLNK 输入 和 复位 ECHO, ， 检 测 起 
始 回 波 之 后 出 现 的 回流。 使 用 说 明 书 建议 在 ECHO 指 
示 至 少 440ks 之 后 ，BLNK 脉冲 应 该 延 时 ， 以 便 回 波 
中 出 现 所 有 16 个 返回 周期 并 允许 脉冲 衰减 到 低 于 
最 大 的 可 观测 回 波 的 门限 值 。 最 大 的 回 波 通常 使 得 检 
测 电路 饱和 ， 提 供 一 个 预 设 的 最 大 值 。 这 个 持续 时 间 
相当 于 处 理 后 的 信号 在 门限 之 上 的 时 间 间 隔 ， 如 图 
21. 14a 所 示 。 

当 观 测 到 一 个 ECHO 事件 时 ，PAS 系统 向 BLNK 
输入 线 发 出 3hs 的 短 脉冲 (相当 于 一 个 软件 的 查询 
周期 ) ， 清 除 ECHO 信号 ， 如 图 21. 14c 所 示 。 在 被 清 
除 前 ，Polaroid 模块 执行 延 时 ， 与 回 波 振幅 成 反比 ， 
大 振幅 回 波 至 少 持续 140ks， 若 处 理 后 的 回 波 信和 号 仍 
然 超过 门限 ， 就 产生 另 一 个 ECHO 事件 。 每 当 观 察 到 
一 个 ECHO 事件 ，PAS 系统 就 不 断 发 出 BLNK 脉冲 。 
然而 ,一 个 强 回 波 由 ECHO 线 上 的 三 个 脉冲 表示 ， 第 
脉冲 对 应 于 传统 TOF， 再 紧 跟 两 个 脉冲 。 因 为 较 低 
必 幅 的 回 波 超过 门限 值 的 时 间 较 少 ， 所 以 较 弱 的 回 波 
生 两 个 相隔 较 远 的 脉冲 ， 而 一 个 非常 微弱 的 回 波 可 
只 产生 一 个 脉冲 。 

当 进 行 旋转 扫描 时 ， 通 过 沿 换 能 器 轴线 放置 测量 
点 产生 PAS 声呐 地 图 。 由 于 每 个 询问 脉冲 产生 多 个 
读数 ， 因 此 PAS 声呐 地 图 在 每 个 询问 角度 包含 了 多 
个 点 。 于 是 旋转 扫描 形成 弧 ， 用 孤立 弧 表 示弱 回 波 ， 
两 联 弧 表 示 中 等 回 波 ， 三 联 弧 表示 大 回 波 。 举 例 说 
明 , 图 21.15 给 出 了 放 在 1m 距离 内 的 大 平面 体 
(2.3m 宽 、0. 6m 高 ) 、 五 个 不 同 直径 的 柱 体 所 形成 的 
弧 。 检 查处 在 相同 距离 的 物体 可 消除 该 模块 距离 相关 
增益 造成 的 影响 。 


| 


全 二 


物体 圆 弧度 数 /(9) 
平面 体 J 83 
8.9cm 直 径 柱状 体 一 一 24.6 
2.85cm 直 径 柱 状 体 = 23.1 
8mm 直 径 杆 状 体 === 21.9 
1.5mm 直 径 导 线 ——— 19.2 
0.6mm 直 径 导 线 — 10.5 
图 21. 15 六 个 位 于 1m 距离 内 的 物体 产生 的 PAS 声呐 地 图 
(声呐 放 在 图 中 物体 的 下 面 ) 


相 比 之 下 ,传统 TOF 声呐 地 图 只 显示 每 个 物体 
所 产生 的 PAS 地 图 中 最 近 的 弧 。 从 定性 角度 来 说 ， 
随 着 依赖 于 方位 的 回 波 振幅 的 增 大 ， 弧 长 增 大 ， 弧 的 
数量 也 增加 。 最 强 的 反射 体 产 生 思 弧 '* “1 发 生 这 种 
情况 是 因为 回 波 振 幅 远 远大 于 门限 ， 而 门限 在 回 波 开 
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始 附近 就 被 超过 了 ， 产 生 一 个 在 方位 上 很 大 程度 接近 
恒定 的 距离 读数 。 相 比 之 下 ， 最 弱 的 反射 体 产 生 凸 
弧 ， 这 是 由 于 振幅 比 得 上 门限 的 回 波 造成 的 。 当 回 波 
振幅 减少 时 ， 在 沿 着 处 理 回 波 波形 的 稍 后 点 处 门限 被 
超过 ， 产 生 较 大 的 距离 读数 。 这 个 效应 也 出 现在 强 反 
射 体 所 产生 的 弧 的 边缘 。 

计算 振动 辩 模 型 的 波束 图 "1 得 到 的 曲线 如 图 
21.16 所 示 ， 该 模型 是 对 Polaroid HE 4509 cr IE JT 
此 图 显示 了 检测 回 波 大 小 ， 被 归 一 化 到 最 大 值 为 
0dB， 沿 着 波束 轴 出 现 。 较 大 的 回 波 远 远 大 于 门限 ， 
比如 平面 体 产生 的 回 波 ， 相 对 于 门限 其 最 大 振幅 可 达 
44dB。 -44dB 门限 与 平面 的 PAS 地 岁 一 致 : 强 回 波 
三 条 纹 ) 出 现在 垂直 和 人 射 10" 以 内 ， 在 +15.6" 回 波 
振幅 减少 引起 距离 读数 增加 ， 在 x14. 7" 接 近 预 测 零 
位 ， 也 会 出 现 来 自 旁 为 的 小 振幅 回 波 。 当 它们 的 轴 上 
回 波 归 一 化 到 0dB 时 ， 较 弱 的 反射 体 与 较 大 的 门限 
相对 应 。 波 束 图 模型 说 明 弧 长 如 何 随 物 体 反 射 强度 变 
化 而 变化 。 通 过 角 波 束 宽度 与 弧度 相配 ， 可 得 到 指定 
的 门限 。 
BERI dB 


一 20 -10 0 10 


20 

方位 /(9) 
图 21. 16 发 射 器 /接收 器 波束 图 

(点 虚线 表示 每 个 对 象 的 等 价 门限 值 ) 


很 明显 ，PAS 地 图 提供 用 于 解决 逆 问 题 的 有 用 信 
息 ， 即 从 回 波 确 定 目 标的 身份 。 图 21. 15 表明 ，PAS 
地 图 包含 回 波 振幅 信息 。 由 最 邻近 的 弧 所 表示 的 常规 
TOF 声呐 地 图 能 从 弧 中 心 确定 出 目标 位 置 ， 且 能 从 弧 
的 大 小 推断 出 回 波 振幅 ， 而 这 个 信息 以 更 加 有 效 的 方 
式 出 现在 PAS 地 图 中 也 是 事实 。 针 对 孤立 对 象 的 简 
单 实例 ， 柱 状 体 是 明显 区 别 于 杆 状 体 的 ， 而 相应 的 常 
规 TOF 弧 也 是 可 比较 的 。 柱 体 直径 增 大 十 倍 仅仅 引 
起 常规 TOF 弧 长 的 适度 增加 ， 而 PAS 地 图 中 弧 的 数 
量 由 2 增加 到 3。 


当 检 查 全 部 回 波 波 形 时 ， 必 须 从 声学 上 解释 目标 
相互 作用 时 产生 的 伪 影 。 一 些 伪 影 在 第 一 个 检测 回 波 
之 后 出 现 ， 因 此 在 TOF 声呐 地 图 中 这 些 并 不 是 难 
BiU. (BERRE PAS 地 图 时 不 可 回避 。 考 虑 一 个 
由 两 个 柱 体 组 成 的 简单 环境 : 一 个 柱 体 (p) 的 直径 
为 2.85cm、r=1m、 方 位 角 为 12* ， 男 一 个 柱 体 (CP) 
的 直径 为 8.9cm、r=1.3m、 方 位 角 为 -10°*。 相 应 的 
PAS 地 图 如 图 21. 17 所 示 ， 显 示 了 两 个 物体 的 回 波 以 
及 表示 两 类 多 反射 伪 影 的 附加 回 波 。 由 A 和 B 表示 
的 第 一 类 伪 影 ， 在 只 有 一 个 物体 处 在 换 能 器 波束 内 时 
产生 。 经 反射 体 改 变 方向 的 询问 脉冲 必须 返回 到 波束 
图 中 的 接收 器 ， 才 能 被 检测 到 。 实 施 这 一 过 程 的 路 径 
已 显示 在 图 中 。A 中 的 单一 凸 弧 形状 表明 回 波 具 有 小 
的 振幅 。 这 是 合理 的 ， 因 为 两 个 反射 体 都 是 非 平面 
的 ， 因 此 很 微弱 。 
第 二 类 伪 影 (C) 如 图 21. 17 所 示 ， 当 两 个 物体 
都 位 于 波束 图 内 时 出 现 。 这 人 允许 回 波 以 两 种 截然 不 同 
的 路 径 返 回 至 接收 器 ， 两 种 路 径 的 方向 相反 ， 且 使 伪 
影 振幅 增加 一 倍 。 由 于 两 个 物体 靠近 波束 边缘 ， 因 而 
回 波 振 幅 小 。 因 为 这 些 回 波 传播 距离 比较 远 物 体 的 距 
离 稍微 大 些 ， 所 以 这 个 伪 影 出 现 的 距离 比较 远 处 物体 
稍微 远 一 些 。 这 两 种 成 分 的 肆 加 使 得 较 远 物体 产生 的 
回 波 看 上 去 可 以 及 时 扩展 。 这 种 脉冲 伸展 解释 了 为 什 
么 能 观察 到 四 个 弧 ， 并 且 某 一 角度 可 观察 到 五 个 弧 。 
WR p 与 P 之 间 的 方位 角 被 增 大 到 超过 波束 宽度 ， 那 


3 
跨 距 /m 


图 21.17 直径 为 2.85cm 的 柱 体 (p ) 和 直径 为 8. 9cm 
的 柱 体 (P) 产生 的 PAS 声呐 地 图 。 换 能 器 放置 于 坐标 
点 (0, 0) 处。 A: 回 波 产生 的 伪 影 ， 该 回 波 起 源 于 发 
HAT, 经 p 反射 给 P， 又 被 P 反 弹 给 p， 再 经 p 定向 传 
给 接收 器 R。 
R. C: Top>PoR fil TOPOp—R 


(Top—PpR). B: T>P-p—P— 
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传 感 与 感知 


么 该 伪 影 将 消失 。 


21.10 回声 波形 处 理 


本 方 阐述 用 于 处 理 采 样 数字 化 接收 屁 波 形 的 脉冲 
回 波 声 呐 。 这 些 系 统 提供 了 比 前 述 简 单 的 Polaroid W 
中 模块 系统 更 优越 的 性 能 ， 测 距 模 块 系统 报道 了 基于 
门限 的 TOF。 然 而 ， 回 波 波形 处 理 导 致 复杂 电子 设备 
和 信和 号 处 理 上 的 开销 ， 不 容易 在 市 场 上 买 到 。 


测 距 与 宽带 脉冲 


参考 文献 [21.11, 46] 表明 ，TOF 最 大 似 然 估 
计 器 (MLE) 可 通过 最 大 化 接收 脉冲 p(1) CATH 
AH) 以 及 可 由 7 改变 的 已 知 脉冲 形状 rec(t -7) 
之 间 的 相关 系数 cor(T) 获得 


[pla)rects - T)dt 


Jir (t) dif rec’ (1) dt 


式 中 ， 脉 冲 从 时 间 a SESS] b, Beli c E AES pp 
状 取 决 于 相对 各 自 换 能 器 法 线 的 接收 和 发 射 角 。 脉 冲 
形状 可 以 通过 收集 信 噪 比 好 的 信号 获得 ， 信 和 号 在 lm 
范围 内 向 接收 器 和 发 射 器 垂直 入 射 ， 并 使 用 椭圆 脉冲 
响应 模型 在 不 同 的 垂直 人 射 角度 获得 模板 脉冲 。 由 于 
空气 传播 损失 导致 的 吸收 分 散 特性 ， 脉 冲 形状 也 随 距 
离 而 变化 。 这 些 可 以 采用 脉冲 响应 估计 来 建 模 ， 归 功 
于 参考 文献 [21.11] 所 做 的 穿 过 空气 的 一 米 通道 。 

按照 式 (21.15) 将 相关 系数 cor(t) 归 一 化 到 
-1 5+1 之 间 。 因 此 ， 最 大 相关 系数 很 好 表示 了 期 
望 脉冲 形状 与 实际 脉冲 形状 之 间 的 匹配 度 ， 可 用 来 评 
ffr TOF 估计 品质 。 实 际 上 ， 式 (21.15). 用 于 离散 时 


21. 10. 1 


cor(T) = (21. 15) 


是 通过 采用 300 V. 脉冲 激励 发 射 器 获得 的 ， 并 从 有 具 有 
类 似 于 图 21. 6d 中 脉冲 形状 的 装置 中 近似 获得 脉冲 
响应 。 


21.10.2 方位 估计 


已 提出 许多 方位 估计 的 方法 。 通 过 利用 接收 脉冲 
形状 对 接收 角 的 依赖 性 ， 单 一 换 能 器 ”1 可 以 被 使 
用 。 这 种 方法 适用 于 半 波 束 宽度 之 内 的 角度 ， 因 为 肪 
冲 形状 是 关于 换 能 器 法 线 角 对 称 的 。 最 大 脉冲 振幅 两 
边 过 零点 次 数 的 差异 可 被 用 来 获得 大 约 1° 的 精度 。 
其 他 单一 接收 器 技术 依靠 来 自 扫 描 场 景 的 重复 测 
量 *”3， 且 在 非常 低 的 感 测速 度 下 达到 相似 的 精 
度 级 别 ， 因 为 多 次 读数 是 必要 的 。 

另 一 个 单一 测量 方法 依赖 于 两 个 或 多 个 接收 
器 "4 这 导致 了 通信 问题， 数据 必 须 在 各 接收 
器 之 间 关 联 。 接 收 器 之 间 的 间隔 越 靠 近 ， 通 信 过 程 越 
简单 、 可 靠 。 这 种 方位 精度 随 大 的 接收 器 间隔 而 提高 
的 误解 ， 忽 视 了 测量 误差 之 间 的 相关 性 ， 测 量 误差 的 
产生 是 由 于 测量 值 共 享 了 超声 传播 过 程 中 重 羡 的 大 气 
空间 。 由 于 TOF 估计 的 高 精度 "， 接 收 器 可 以 采 
用 尽 可 能 近 的 、 物 理 可 实现 的 间隔 (35mm) 放置 ， 
尽管 如 此 ， 还 是 有 报道 称 取得 了 低 于 任何 其 他 系统 的 
方位 精度 。 据 报道 在 - 10° ~ + 109 JE SE SEE, 4m 范 
围 内 ， 方 位 误差 的 标准 差 低 于 0. 2°。 

有 两 种 常用 的 方位 估计 方法 ， 即 两 侧 振 幅 差 
(TAD) P5 $n pi Ail ERY [a] REG 28. (ITD ) 富生 9 | 
TAD 使 用 两 个 接收 器 彼此 远离 指向 ， 以 便 每 个 接收 波 
束 宽度 内 回 波 有 不 同 的 振幅 响应 。 在 ITD 中 ， 两 个 接 
收 器 通常 指向 同一 方向 ， 测 出 每 个 接收 器 的 TOF, Jf 
应 用 三 角 测 量 法 确定 到 达 角 。 方 位 计算 依赖 于 目标 类 
型 ， 比 如 平面 、 角 或 边 ， 这 些 几何 形状 已 在 参考 文献 


间 形 式 ， 积 分 都 由 乘积 和 代替 ， 并 且 由 于 数字 信和 号 处 
理 器 进行 这 种 计算 是 经 过 高 度 优化 的 拉 ”” ， 因 此 
它们 是 理想 的 执行 器 。 为 了 利用 小 于 离散 时 间 采 样 率 
的 分 辩 率 实现 到 达 时 间 人 估计， 抛物 线 插 值 法 可 被 用 于 
最 大 的 三 个 相关 系数 '”"。 我 们 关心 的 是 TOF 估计 
器 由 于 接收 器 噪声 而 产生 的 抖动 标准 差 o,。 由 参考 
文献 [21.11, 46] 可 知 


o 


B j > rec( £T, )? 
式 中 ,是 求 和 指标 ， 用 来 指示 每 隔 7T.(s) (参考 文 
MR [21.11.47] WEM lus) 采样 得 到 的 全 部 接收 器 脉 
冲 ; 中 表示 接收 器 脉冲 的 带宽 ; co, 是 接收 器 噪声 的 标 
准 差 。 式 (21.16). 表明 在 TOF 估计 器 中 宽带 高 能 脉 
冲 可 获得 较 低 的 误差 。 在 参考 文献 [21.11] rh, x 


(21. 16) 


Ogn- 


[21.11] 中 得 到 分 析 。 一 个 具有 收发 器 和 接收 器 的 
简单 装置 如 图 21. 18 所 示 ， 图 中 TRI 表示 收发 器 ， 
R2 表示 第 二 个 接收 器 ,彼此 以 距离 d 隔 开 。 发 射 器 
的 虚拟 图 像 表示 为 T'。 在 两 个 接收 如 上 测 得 的 两 个 
TOF 分 别 是 fl c, 被 用 来 估计 方位 角 9， 即 与 平面 
法 线 之 间 的 夹 角 。 对 图 21.18 中 的 R2、R1、T' 应 用 
余弦 定律 ， 可 得 


ee 
tcti-cecth 


d 
cos(90° — 0) =sin = 


e (21.17) 
M deca, 3X (21.17) 可 用 下 式 近 似 
Ra et (21.18) 


d 
注意 : t, 和 4 中 任何 共 模 ( 即 相 关 ) 噪声 都 可 用 式 
(21.18) 中 的 差分 加 以 去 除 ， 因 此 在 上 述 方位 估计 


第 21 章 声呐 感 测 51 


图 21.18 用 收发 器 TRI 和 接收 器 R2 计算 平面 
的 方位 角 (0) (TE T REL 


中 不 能 忽略 TOF 中 噪声 成 分 的 相关 性 。 
关于 角 的 情况 如 图 21.19 所 示 , 式 (21.17) F 

样 适用 并 可 得 出 相同 结果 。 图 21. 20 给 出 了 有 关 边 的 

情况 ，R1 具有 从 了 T 到 边 再 返回 到 RI 的 TOF， 同 时 

R2 具有 从 T 到 边 再 返回 到 R2 的 TOF。 从 几何 上 ， 我 

们 采用 与 式 (21. 17) 同样 的 方法 得 出 

d «65/4 -c(t -1]/72) 

2dct, /2 


sinô = 


(21.19) 
d cn -u) 
= dct, 
: 4d<<i, Hf, 5X (21.19) 可 由 式 (21.18) 


图 21. 19 用 收发 器 TRI 和 接收 器 R 计算 角 
的 方位 (9 ) (TR T REAL) 


Ch-c 11/2 


TRI 


图 21.20 用 收发 器 TR] 和 接收 器 R2 计算 边 的 方位 角 (6 ) 
(因为 边 是 从 边缘 的 一 个 点 源 向 外 辐射 ， 所 以 不 会 出 现 虚像 ) 


21.11 CTFM 声呐 


连续 传输 调频 (CTFM) 声呐 与 前 面 几 节 描述 的 
常规 脉冲 回 波 声呐 的 不 同 之 处 在 于 传输 编码 和 从 接收 
器 信号 中 提取 信息 的 处 理 过 程 。 

21. 11.1 CTFM 传输 编码 

CTEM 发 射 器 不 断 地 发 出 不 同 频率 的 信号 ， 通 
常 是 锯齿 形 ， 如 图 21. 21 所 示 ， 一 般 每 隔 扫 频 周期 
7 扫 过 一 个 倍 频 程 。 频 率 线性 变化 的 发 射 信 号 可 表 
示 为 


S(t) 2 cos[2m( fyt — bt’) |] (21. 20) 

对 于 0<:< 了 成 立 。 扫 频 周 期 每 隔 T(s) 重复 ， 如 图 

21.21 所 示 。 频 率 是 式 (21.20) 中 相位 时 间 倒 数 的 

1Z2T。 需 要 注意 的 是 ， 最 高 频率 是 户 ， 最 低 发 射频 

率 是 广 -207， 其 中 必 是 确定 扫描 速率 的 常量 。 我 们 
可 以 定义 扫描 频率 AF 如 下 

AF =2bT 


(21.21) 


0 T 2T 时 间 


图 21.21 CTFM 频率 -时 间 图 (如 果 显 示 的 回 波 对 应 
于 最 大 距离 R ,处 的 目标 ， 则 应 用 目标 中 断 时 间 ) 


21. 11.2 CTFM TOF 估计 


发 射 波 阵 面 遇 到 反射 体 时 产生 回 波 ， 回 波 是 发 射 
Asstt, CRT wy. 
E(t) =48(+-=2) 


式 中 , R 是 到 反射 体 的 距离 ; c 表示 声速 ; 4 表示 在 
由 线 物体 情况 下 依赖 于 声音 反射 频率 的 振幅 。 

通过 解 调和 频谱 分 析 两 步 过 程 估 计 TOF。 解 调 是 
通过 发 射 信号 副本 与 接收 信号 相 乘 以 及 低 通 滤波 来 实 
现 的 。 在 只 有 一 个 回 波 的 简单 情况 中 这 是 最 容易 理解 
的 。 利 用 式 (21.20) 和 式 (21.22) 可 以 得 到 信号 
D(t) 


(21.22) 
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D(t) 2 E(1)S(1) 
=f eos(2 f.t—) *cos(2m ft - 2b -4)] 


(21.23) 


.2R ADR. 
; Q= fu + E o 


[4 


ath, =A, 人 = (244%) 


此 处 , 式 (21.24) 的 三 角 人 恒等式 已 被 用 于 式 
(21.23) 中 


c 


cos(x)cos(y) = 3 [cos(x—y) +cos(x+y) ] 
(21.24) 
低 通 滤波 器 滤 除 高 于 i 的 频率 成 分 ， 可 导出 下 列 基 


带 信号 


D,(1) = 4 | cos (20-4) (21.25) 


它 具有 一 个 与 距离 R 成 正比 的 频率 。 通 过 检查 D, ASI 
谱 提取 回 波 的 距离 ， 例 如 ， 如 果 采 样 数量 是 2 SEX 
方 ， 就 可 以 使 用 离散 传 里 叶 变 换 (DFT) 或 者 快速 傅 
里 叶 变换 (FFT) 。 式 (21.25) 中 ， 对 于 频率 峰值 
Hz， 相 应 的 距离 R 可 表示 为 
R= fz 
需要 注意 的 是 ， 对 于 目标 中 断 时 间 R, 2c, WE 
分 析 依赖 于 在 每 个 扫描 起 始 阶段 排除 接收 器 波形 ， 其 
中 及 ,表示 最 大 目标 距离 。 在 目标 中 断 时 间 期 间 ， 接 
收 器 信号 依赖 于 以 前 的 扫描 而 不 是 当前 扫描 ， 这 正如 
上 述 分 析 假 设 的 那样 。 扫 描 时 间 了 要 远 远大 于 声响 有 
效 运 作 的 目标 中 断 时 间 。 目 标 中 断 时 间 可 被 消除 ， 但 
正如 参考 文献 [21.53] 描述 的 那样 ， 以 增加 解 调 
过 程 的 复杂 性 为 代价 ， 该 文献 采用 了 交错 双 解 调 
方案 。 


21. 11.3 CTFM 距离 鉴别 力 和 分 辨 率 


我 们 对 距离 鉴别 力 的 定义 是 同时 检测 出 的 两 个 截 

然 不 同 的 目标 的 距离 间隔 。 距 离 分 状 率 被 定义 为 声呐 

测量 距离 的 最 小 增 量 。 

假设 为 了 提取 目标 距离 , XD (21.25) 中 的 D, 

G) 是 以 AT 间隔 采样 的 ， 在 进行 DFT (或 者 FFT) 

之 前 ,收集 好 个 样本 (如 果 丰 是 2 RUE). 

DFT 的 频率 样本 将 是 分 散 的 Af=1/(kA7T)。 根 据 式 

(21. 26) ， 这 可 表示 距离 分 辩 率 AR 为 

cA f c 

AR = = AT 

我 们 可 以 将 其 与 式 (21.21) 中 的 扫描 频率 AF 联系 
起 来 ， 即 


(21.26) 


(21.27) 


c T 


式 中 ， 第 二 项 表示 扫描 时 间 与 频谱 采样 时 间 的 比率 。 
为 了 区 分 DFT 中 的 两 个 峰值 ， 它 们 必须 是 两 个 分 离 
的 样本 ， 由 此 可 得 
EX C T 
距离 鉴别 力 = AF IAT 
在 式 (21.28) 和 式 (21.29) 中 需要 注意 的 是 ， 
受 峰 值 信 噪 比 约束 的 影响 ，CTFM 可 以 延长 数值 积分 
时 间 kAT， 以 提高 声呐 的 距离 鉴别 力 和 分 辨 率 。 也 有 
可 能 ， 由 于 信号 噪声 的 影响 ,在 DFT 峰值 使 用 插值 
方法 (如 抛物 线 插值 法 ) 来 解决 小 于 Af 的 频率 ， 从 
而 提高 距离 分 辨 率 (但 不 是 距离 鉴别 力 ) 。 


21. 11.4 CTFM 声呐 和 脉冲 回 波 声呐 的 比较 


1) 当 给 定 相同 的 峰值 信 品 比 和 带宽 ， 脉 冲 回 波 
声呐 和 CTFM 声呐 的 距离 分 辩 率 理论 上 是 相同 
的 ”I。 在 脉冲 回 波 声呐 中 ， 距 离 鉴 别 力 受 脉冲 宽 
度 的 限制 ， 较 短 的 脉冲 长 度 需 要 较 大 的 带宽 。 然 而 ， 
在 CTEM 中 ,距离 鉴别 力 可 通过 增加 数值 积分 时 间 得 
以 提高 ， 让 设计 更 具有 灵活 性 。 

2) CTEM 也 考虑 到 发 射 信号 的 能 量 随时 间 均 匀 
散布 ， 导 致 相 较 于 具有 相同 接收 器 峰值 信 噪 比 的 脉冲 
回 波 系统 ， 它 具有 较 低 的 声 功率 发 射 峰值 。 在 实际 环 
境 下 CTEM 能 提供 较 大 的 平均 功率 ， 因 此 对 弱 反 射 体 
具有 较 大 敏感 性 是 可 能 的 。 

3) CTEM 需要 更 加 复杂 的 发 射电 路 和 接收 器 端 
的 FFT 处 理 。 

4) 单独 的 发 射 器 和 接收 器 换 能 器 是 CTFM 必需 
的 ， 而 脉冲 回 波 系统 可 使 用 单一 换 能 器 进行 发 射 和 接 
收 ， 导 致 脉冲 回 波 声呐 的 最 小 距离 限制 ， 归 因 于 传输 
过 程 中 接收 器 的 消 隐 。CTFM 对 最 小 距离 没有 内 在 
约束 。 

5) CTFM 声呐 能 每 隔 KAT(s) 不 断 地 从 目标 获 
得 距离 信息 ， 延 迟 时 间 为 R/c + kAT， 相 较 而 言 ， 肪 
回 波 声呐 〈 两 者 都 忽略 处 理 延 迟 ) 是 每 隔 2R,/c, 
人 迟 时 间 为 2RMe， 这 在 实时 跟踪 应 用 中 可 能 是 重 
的 。 

6) CTEM 的 其 他 好 处 是 每 个 周期 距离 测量 的 数 
只 受 峰 值 信 噪 比 和 式 (21.28) 中 距离 鉴别 力 的 


(21.29) 


B= 


m 
= 


7) 在 移动 平台 的 目标 分 类 和 方位 估计 方面 ， 像 
参考 文献 [21.26, 47] 中 的 短 脉冲 回 波 声呐 系统 ， 
不 会 有 CTFM 数值 积分 时 间 问 题 ， 数 值 积分 时 间 被 用 
来 精确 估计 相应 于 距离 (进而 方位 ) 的 频率 。 在 数 
值 积分 时 间 中 ， 目 标 可 以 相对 于 传感器 移动 ， 模 糊 了 
测量 值 ， 使 方位 估计 和 分 类 不 甚 准确 。 在 短 脉冲 回 波 
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系统 中 ,采用 小 于 100ks 的 脉冲 对 目标 进行 有 效 采 
样 ， 获 得 与 目标 一 致 的 镜像 。 


21.11.5 CTFM 应 用 


Kay 7?! RF] CTFM 声呐 系统 ， 以 最 高 频率 广 
为 100kHz、 最 低频 率 为 SOkHz, 扫描 周期 7 为 
102. 4ms 进行 扫描 ， 为 盲人 开发 了 一 种 辅助 移动 工 
具 。 解 调 后 ， 当 频率 达到 5kHz、 相 应 距离 达到 
1.75m 时 ， 该 范围 内 的 声音 是 可 以 听见 的 。 该 系统 使 
用 一 个 发 射 句 和 三 个 接收 器 ， 如 图 21. 22 所 示 。 系 统 
使 用 者 可 以 从 立体 声 耳 机 中 听 到 解 调 后 的 信号 ， 立 体 
声 耳 机 对 应 于 左右 两 边 的 接收 器 ， 每 个 接收 器 都 是 与 
位 于 中 央 的 大 椭圆 形 接收 器 相 混合 的 。 较 高 的 频率 与 
较 远 的 距离 相对 应 。 为 了 说 明 其 敏感 性 ，1 根 直径 
的 回 波 是 35dB ， 高 于 系统 背景 噪声 。 


图 21.22 盲人 辅助 工具 一 一 小 的 椭圆 形 换 能 器 是 发 射 
器 ， 其 他 三 个 部 件 是 接收 器 。 大 的 椭圆 形 接 收 器 提供 高 
分 辩 率 ， 由 使 用 者 颈 部 灵活 控制 加 以 固定 (照片 由 参考 
文献 [21. 54 ] 提供 ) 


CTEM 声呐 已 被 用 来 识别 孤立 的 植物 Ps 。 
CTFM 所 获得 的 优势 是 在 给 定 的 解 调 接收 信号 频谱 


下 ， 广 泛 的 距离 和 回 波 振 
在 频率 从 100kHz 到 50kHz 


囊 信 息 可 从 整 株 植物 获得 ， 
的 一 个 倍 频 程 激励 下 获得 


这 些 回 波 ， 具 有 高 的 信 噪 比 以 便 叶 子 产 生 的 弱 回 波 


可 被 感 测 到 。 这 种 信息 被 称 作为 声 密度 章 


il, 4419 


种 不 同 特征 对 分 类 植物 有 


用 ， 比 如 高 于 振幅 门限 的 


距离 单元 的 数量 、 所 有 距离 单元 的 总 和 、 有 关 质 心 


的 变化 、 第 一 个 振幅 单元 到 最 高 振幅 单元 之 间 的 距 
离 、 检 测 到 的 反射 距离 。 对 于 100 种 植物 群体 ， 采 
用 统计 分 类 器 可 平均 获得 90. 6% 的 成 对 分 类 准 
确 率 。 

用 单一 发 射 器 和 单一 接收 器 扫描 CTEM 已 成 功 应 
用 于 包括 光滑 表面 和 粗糙 表面 的 室内 环境 的 地 图 构 
gE" ， 光 滑 表面 的 方位 误差 近似 0.5"， 边 缘 的 方 
位 误差 则 更 高 。 使 用 振幅 信息 进行 分 类 ， 采 用 距离 对 
振幅 信息 归 一 化 ， 而 距离 使 用 了 声音 的 固定 衰减 常 
量 。 在 实践 中 ， 这 个 衰减 常量 随 温 度 和 湿度 而 变化 ， 
在 每 次 实验 想 得 出 一 致 结果 之 前 需要 校准 。 已 证 实 
TOF 分 类 方法 要 取得 更 好 的 鲁 棒 性 、 速 度 和 准确 性 ， 
至 少 需要 两 个 发 射 器 位 置 和 两 个 接收 器 ， 正 如 参考 文 
献 [21.11, 47] 描述 的 一 样 。CTFM 可 应 用 于 阵列 
系统 ， 可 比 现 有 的 脉冲 回 波 系统 获得 对 微弱 目标 更 高 
的 灵敏 度 。 

CTFM 已 广泛 应 用 于 三 路 立体 声 系统 ， 基 于 
不 同 的 距离 和 方位 估计 器 ， 对 这 些 超 声 感 测 系统 做 了 
严格 的 理论 和 实验 比较 。Stanley'* 中 也 包含 了 CTFM 
声呐 系统 的 详细 工程 设计 信息 。 所 得 的 结论 是 ，CT- 
FM 可 以 使 声 穿 透 大 的 面积 ， 这 是 由 于 CTFM 有 较 高 
的 平均 传输 功率 ， 因 而 具备 良好 的 信 噪 性 能 。 已 发 
现 ， 对 解 调 信号 谱 线 使 用 自 回归 估计 器 ， 可 获得 比 
DFT 更 好 的 分 辨 率 。 除 了 参考 文献 [21.11] 提出 的 
脉冲 回 波 方法 使 用 高 能 短 脉冲 之 外 ， 该 方法 被 认为 在 
方位 精度 具有 6 ~ 8 倍 优越 性 ， 耳 间距 离 和 功率 差 动 
CTFM 方法 可 提供 最 先进 的 性 能 。 


多 脉冲 声呐 


本 节 采 用 多 个 发 射 脉冲 检验 声呐 系统 。 主 要 目的 
是 干扰 抑制 和 即时 分 类 。 利 用 巴克 (Barker) 37077 
生成 较 长 的 发 射 脉冲 序列 ， 多 脉冲 声呐 也 被 用 来 产生 
更 好 的 信 噪 比 。Barker 码 的 自 相 关 性 提供 具有 低 相关 
性 、 远 离 中 心 瘀 的 罕 尖 峰 。 匹 配 滤波 器 引起 脉冲 压 
缩 ， 将 噪声 均 分 以 经 过 较 长 的 时 间 周 期 。 


21.12.1 干扰 抑制 


外 部 噪声 ， 如 压缩 空气 ， 是 一 种 声呐 干扰 源 。 声 
呐 系统 试图 通过 信号 滤波 减 小 外 部 干扰 带 来 的 影响 ， 
最 佳 滤波 器 是 一 种 匹配 滤波 器 ， 脉 冲 响应 是 期 望 脉 冲 
形状 的 时 间 反 演 。 因 为 逆 时 卷 积 是 一 个 相关 系数 ， 所 
以 匹配 滤波 器 扮演 与 21. 10 节 论 述 的 期 望 脉冲 形状 一 
样 的 相关 系数 。 在 具有 与 期 望 接 收 脉冲 频谱 相似 的 频 
率 响应 的 带 通 滤波 带 基 础 上 ， 设计 出 近似 的 匹配 滤波 
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器 。 通 过 采用 匹配 滤波 器 处 理 包 含有 连续 短促 声波 传 
输 中 的 宽泛 频率 ，CTFM 系统 可 对 外 部 干扰 进行 鲁 棱 
抑制 。 

当 多 个 声呐 系统 运行 在 相同 环境 下 ， 从 一 个 声呐 
系统 发 出 的 信号 能 被 另 一 个 系统 接收 ， 造 成 串扰 误 
25, TEH Polaroid 测 距 模块 构建 的 传统 声呐 环 中 ， 这 
是 十 分 明显 的 。 消 除 误差 的 快速 超声 波 激 励 策 略 已 被 
PES) ， 并 声称 可 以 去 除 大 多 数 干 扰 ， 人 允许 更 快 
地 操作 这 些 声呐 环 。 

更 加 复杂 的 发 射 脉冲 编码 方法 已 被 用 来 抑制 外 部 
PAM ERECT PPO! 。 多 发 射 脉冲 要 比 单一 脉冲 经 过 
更 长 的 时 间 周 期 ， 其 困难 之 一 在 于 目标 杂 波 能 在 接收 
器 产生 多 个 重 码 脉冲 ， 这 些 脉 冲 很 难 拆 开 和 解释 ， 声 
呐 距 离 鉴 别 力也 受到 影响 。 


21. 12.2 目标 即时 分 类 


通过 单个 反射 器 和 三 个 接收 器 ， 使 用 单一 测量 
周期 ， 可 实现 将 目标 分 类 为 平面 体 、 圆 柱 体 和 
V8) 。 至 少 需要 两 个 发 射 器 才 可 以 将 平面 体 与 四 
面 直角 体 区 分 开 来 " ， 使 用 两 个 发 射 器 排列 在 连 
续 两 个 测量 周期 内 将 目标 分 类 为 平面 、 角 和 边 。 自 
从 出 现 镜面 反射 声呐 后 ， 分 类 方法 可 被 视 为 虚拟 图 
像 和 反射 镜 。 相 较 于 照 一 个 直角 镜 ， 照 一 个 平面 镜 
会 产生 左右 翻转 的 图 像 。 观 察 边 就 好 比 是 观察 一 个 
高 曲率 的 镜面 ， 比 如 抛光 的 椅子 腿 ， 整 个 图 像 被 压缩 
到 一 点 。 声 呐 分 类 利用 了 来 自 两 个 发 射 器 的 目标 方位 
角 的 差异 ， 如 下 所 示 : 一 个 正 的 差 56 表示 平面 ， 一 个 
负 的 85 值 表示 角 ， 零 差 值 表示 边缘 ， 这 里 的 角度 5 取 
决 于 传感器 的 几何 形状 和 目标 距离 。 通 过 使 用 除了 方 
位 之 外 的 距离 测量 ,采用 最 大 似 然 估 计 ， 可 以 提高 先 
进 性 。 

采用 大 约 35ms ~ 5s 的 测量 周期 进行 工作 ， 这 样 
的 排列 拉 呈 变 得 很 完善 ， 因 此 参考 文献 [21.47] 提 
出 了 “即时 (on-the-fly)” 术 语 。 该 即时 方法 以 精确 
的 时 间 差 AT 激励 脉冲 ， 两 个 发 射 器 相距 40mm， 并 
与 两 个 距离 较 远 的 接收 器 形 成 一 个 正方 形 。A7 通常 
为 200hs 左右 ， 但 随时 间 随 机 变化 ， 以 达到 使 用 相同 
的 声呐 系统 抑制 干扰 (包括 串扰 和 环境 干扰 ) 的 目 
的 。 在 一 个 测量 周期 中 ， 分 类 是 同时 进行 的 。 传 感 顺 
用 和 鲁 棒 分 类 获得 较 高 的 距离 和 方位 精度 ， 利 用 了 不 同 
发 射 器 到 接收 器 路 径 中 TOF 抖动 之 间 的 紧密 相关 性 ， 
而 这 种 相关 性 是 由 于 紧密 的 时 空 排列 造成 的 。 在 参考 
文献 [21.68] 中 ,该 传感器 被 用 于 大 规模 地 图 
构建 。 


21.13 ”声呐 环 


21. 13.1 简单 测 距 模 块 环 


因为 声呐 只 能 检测 位 于 波束 内 的 目标 ， 扫 描 整 个 机 
器 人 外 部 环境 的 常用 办 法 是 使 用 声呐 阵列 ， 或 者 
RC. BeOS Denning 环 ， 它 包含 24 个 声呐 ， 等 
间隔 放置 在 机 器 人 外 围 。15" 间 距 允 许 一 些 声呐 波束 内 
的 重 概 ， 因 而 至 少 有 一 个 声呐 将 检测 到 一 个 强 反射 物 
体 。 环 内 的 声呐 通常 被 顺序 地 使 用 ， 每 次 一 个 。 使 用 
50ms 探测 脉冲 周期 来 减少 错误 读数 ， 则 每 隔 1. 2s 才能 
完成 一 次 完整 的 环境 扫描 。 这 个 采样 时 间 对 于 研究 实验 
中 的 “ 非 连续 性 ”操作 足够 了 ， 但 对 于 不 断 移动 的 机 器 
人 来 说 就 可 能 太 慢 了 。 以 Ims 速度 移动 的 机 器 人 不 能 
检测 物体 ,没有 足够 的 警告 来 防止 碰撞 。 一 些 研究 人 员 
提出 同时 在 环 相反 的 两 端 使 用 声呐 以 加 快 收集 时 间 ， 而 
另 一 些 人 也 减少 了 探测 脉冲 周期 ， 并 试图 识别 伪 影 。 


21.13.2 高 级 环 


Yata 等 中 2 研发 了 一 个 直径 为 32cm 的 声呐 环 ， 
交替 放置 了 30 个 发 射 器 和 30 个 接收 器 。Murata He Hi 
式 MA40S4R 广角 换 能 器 被 用 来 重 辣 接收 回 波 ， 这 些 
回 波 是 同时 激励 所 有 发 射 器 产生 的 。 采 用 轴 对 称 指数 
喇叭 结构 使 得 发 射 器 的 波束 形状 垂直 变 窗 ， 以 避免 来 
自 地 面 的 反射 。 接 收 信号 与 衰减 的 门限 值 做 比较 ， 以 
产生 1 位 无 校正 的 数字 采样 信号 。 由 回 波 的 前 沿 估 计 
Jr, 已 有 报道 称 ， 对 于 多 达 1. 5m 的 距离 ， 方 位 误 
差 的 标准 差 可 达 0. 4°。 

已 开发 出 一 个 含有 七 个 数字 信号 处 理 器 (DSPs ) 
APA HP ERE S561 ， 使 用 了 24 对 Polaroid 7000 系列 
换 能 器 ， 每 个 换 能 器 包含 一 个 收发 器 和 一 个 接收 器 ， 
如 图 21.23 所 示 。 采 用 12 位 模拟 /数字 转换 器 以 
250kHz 频率 采样 两 个 接收 器 通道 ， 再 对 每 个 通道 使 
用 模板 匹配 数字 信和 号 处 理 (0521.10 节 ) ， 每 对 换 能 
器 可 以 获得 距离 和 精确 的 方位 信息 。 总 的 来 说 ， 每 个 
DSP 可 处 理 八 个 接收 器 通道 。 同 时 激励 所 有 收发 器 完 
成 整个 环境 感 测 ， 在 6m 距离 内 大 约 每 秒 钟 感 测 11 
次 ， 实 验 验证 了 光滑 目标 的 距离 与 方位 精度 分 别 是 
0. 6mm 和 0.2°。 为 了 抑制 相 令 对 之 间 的 干扰 ， 在 环 
的 周围 以 隔行 扫描 方式 发 射 两 个 不 同 的 脉冲 形状 。 脉 


冲 形状 都 来 源 于 两 到 三 个 65kHz 的 激励 


周期。 由 于 高 


的 重复 性 以 及 精确 的 距离 和 方位 感 测 ， 


该 DSP 声呐 


环 可 实现 快速 准确 的 沿 墙 运 动 、 构 建 地 
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能 器 对 的 波束 宽度 支持 对 3m 距离 内 平滑 镜面 物体 的 
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360° 45 zz, DSP 声呐 环 产生 同步 定位 与 地 图 构建 
(SLAM) 的 一 个 实例 如 图 21. 24 所 示 。 


Y/m al 


图 21.24 DSP 声呐 环 产生 同步 定位 与 地 图 构建 实例 
(声呐 环 以 10cnvs 速度 移动 ， 采 样 频率 为 11. 5Hz ) 
a) DSP 声呐 环 构建 室内 环境 地 图 b) 原始 数据 
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Æ 21.24 DSP 声呐 环 产生 同步 定位 与 地 图 构建 实例 
(声呐 环 以 10cm/s 速度 移动 ， 采 样 频率 为 11. 5Hz) ( 续 ) 


c) 具有 特征 数量 和 联想 数量 的 SLAM 特征 图 


21.14 运动 影响 

当 一 个 传感器 相对 于 目标 运动 时 ， 声 呐 测量 会 
受到 影响 。 例 如 ， 以 声速 的 1% 速度 (3.4m/s) 移 
动 的 声呐 传感器 将 给 一 些 方位 测量 带 来 0. 6° 的 误 
差 。 线 性 速度 对 TOF 和 接收 角 的 影响 依赖 于 目标 类 
型 ， 因 此 运动 补偿 显得 很 有 意义 ， 对 目标 分 类 传 感 
器 是 必要 的 。 本 节 我 们 考虑 传统 的 平面 、 角 和 边 状 
目标 类 型 。 参 考 文献 [21.26] 讨论 了 旋转 运动 的 
影响 ， 结 果 表 明 非 常 高 速 的 旋转 对 产生 小 的 方位 误 
差 (例如 大 约 1700 度 / 秒 对 应 0.19122) 是 必要 
的 。 有 效 波束 宽度 的 缩小 是 声呐 传感器 高 旋转 速度 
的 另 一 个 影响 。 

假定 传感器 从 一 点 了 发 射 ， 接 收 器 测量 值 是 
以 传感器 上 的 该 点 作为 参考 的 。 然 而 ， 由 于 传 感 
器 的 运动 ， 地 面 参考 位 置 尺 在 回 波 接收 时 已 从 了 
移动 了 整个 TOR TH, WARE, T5 RÈ 
间 的 距离 是 TOF xv, FEP v 是 相对 地 面 的 传感器 
速度 矢量 的 大 小 ， 速 度 矢 量 分 量 v, 和 vw, 分 别 平行 
于 它们 各 自 的 坐标 轴 。 因 为 仅仅 运用 了 声音 传播 
和 反射 的 物理 学 原理 ， 所 以 针对 线性 运动 推导 出 
的 表达 式 可 应 用 于 任何 声呐 传感器 。 所 有 目标 都 
被 认为 是 静止 的 。 

本 节 是 基于 参考 文献 [21.26] 的 ， 其 中 还 可 以 
找到 本 节 没 有 包含 的 更 多 实验 工作 。 


21. 14.1 平面 的 移动 观测 


平面 目标 反射 从 位 置 7 到 R 的 传播 ， 如 图 
21.25a 所 示 。TOF 被 分 解 成 两 部 分 : 4 表示 传播 到 平 


an 
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面 的 时 间 , ,表示 从 平面 到 接收 费 R 的 时 间 。 这 里 ， 
我 们 可 获得 线性 运动 对 TOF = 1, + 已 以 及 接收 角 o 的 
影响 ， 两 者 都 是 从 静止 观测 者 的 角度 来 看 的 。 移 动 的 
观测 模式 将 在 下 面 讨论 。 

从 图 21. 25a 左边 的 直角 三 角形 ， 我 们 可 推导 出 


sings A 
四 (21. 30) 
cosO= /1- (>) 
c 
还 可 导出 
d, d, 
cos) = 一 -一 = (21.31) 
tic ccosÜ 


ME 21. 25a 右边 的 直角 三 角形 ， 我 们 可 得 出 


(t, * 1) v, +d, (t, +t, )v, +d, 
E - ees - 


cosÜ 


Lc ccosO 
(21.32) 
将 式 (21.31) 与 式 (21.32) 相 加 可 得 出 TOR, 


然后 带 入 式 (21.31) 中 可 得 


2d 
TOF = (a } 
€ vov, 
[1 
c c 


X (21.33) 中 第 一 个 因子 表示 静止 TOF。 当 速度 趋 
近 零 时 ， 第 二 个 因子 接近 单位 1。 


21.14.2 角 的 移动 观测 


图 21. 25b 给 出 了 角 观 测 的 情况 ,7 的 虚像 表示 
为 了。 从 直角 三 角形 T'XR 
c"TOF? = (2d, +v, TOF)? «v TOF? (21.34) 


= fake (21.35) 
is | 

RP, wa tvo X (21.35) 的 左边 项 表示 静止 

TOF， 右 边 项 在 小 速度 时 接近 单位 1。 图 21. 25b 中 的 

SABE p 是 由 于 以 静止 观测 者 为 参照 物 的 运动 造成 的 

角度 偏差 。 由 三 角形 T'XR 和 CXR 可 得 


(21. 33) 


we 
2d, +v, TOF (21.36) 
tan( 0 4 $) sr 
d, +v, TOF 
由 式 (21.36) 可 得 
tan(0 4$) = (2- tor (21.37) 


求解 tang 可 得 


aR 


D 


(fi * t2)Vy 


b) 


Æ 21.25 从 移动 的 传感器 观测 目标 (了 表示 发 射 器 的 
位 置 ，R 表示 TOF 结束 时 接收 回 波 的 位 置 ) 
a) 平面 目标 b) 角 状 目标 c) 边 状 目标 


1 - sin’ 
tano = tang| v, TOF 
d 


+1+sin20 
1 


[A 1 -sin20 
=| 2d TOF 21.38 
TOR +, E +1+sin0 ( ) 


对 于 v ， v, <<c, sing ««1 fü 2d,/TOF~c, 3X (21.38) 
可 近似 为 


$- (21.39) 


21.14.3 边 的 移动 观测 


因为 边 状 体 从 有 效 点 源 再 辐射 人 射 的 超声 波 ， 相 
对 于 静止 观测 者 的 接收 角 不 受 运动 的 影响 ， 如 图 
21.25c 所 示 。TOF 受 移 动 接收 位 置 的 运动 的 影响 。 
由 直角 三 角形 XER, dj - (d, *v,)^ «v; TOF fI d, + 
d, 2 cTOF 可 导出 
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2d c | 2d 
TOF = 一 7 |= 一 


C vU [4 


(1+) (21.40) 


对 于 v <<c,， 式 (21.40) 近似 成 立 。 
21.14.4 ”接收 角 和 移动 观测 的 影响 


在 前 面 章节 中 接收 角 的 表达 式 是 基于 相对 传播 介 
质 (空气 ) 静止 的 观测 模式 的 。 实 际 上 ， 观 测 者 是 
传感器 ， 以 速度 " 移动 。 假 设 声呐 波 相 对 于 空气 以 角 
度 a 到达， 如 图 21.26 所 示 。 相 对 于 观测 者 ， 波 阵 面 
的 速度 分 量 w, 和 w, 定 义 如 下 


w, —csino — v, 


(21.41) 
由 式 (21.41) 可 得 观测 出 的 到 达 角 B, KRA 


Ww, 三 CCOSQ — v, 


csing — v sina — = 
tan = — E (21.42) 
CCOSQ 一 v, y 
cosa — — 
c 
移动 观测 者 


到 达 波 方向 


图 21 26 观察 来 自 移动 观测 者 的 到 达 波 


21.14.5 平面 、 角 和 边 的 移动 观测 到 达 角 


在 本 节 中 ， 对 每 个 目标 类 型 的 到 达 角 (rad) 进 
行 了 总 结 ， 并 对 移动 机 器 人 的 期 望 速度 进行 了 粗略 估 
计 。 速 度 被 假定 为 不 足 声速 (在 室内 温度 下 声速 通 
常 是 340m/s) 的 几 个 百分点 。 在 lm/s 速度 下 ,已 有 
实验 观察 到 这 些 影响 。 

式 (21.41) 与 式 (21.30) 正好 抵消 ， 对 于 平 
面目 标 ， 与 传感器 相关 的 到 达 角 刚好 等 于 零 ， 即 

Due =9 (21.43) 
这 可 以 解释 为 当 反 射 保持 前 向 波 速度 分 量 时 ， 该 分 量 
总 是 与 传感器 的 分 量 一 样 。 

对 于 角 状 目标 ， 角 度 由 导致 波 阵 面 似乎 在 与 来 
自 真实 角 方向 的 传感器 运动 相同 的 方向 上 被 取代 了 ， 
如 图 21.25b 所 示 。 移 动 观 测 者 的 影响 加 倍 了 这 种 效 
果 ， 可 从 式 (21.39) 和 式 (21.41) 看 到 。 


2 
Bana ™ 一人 (21. 44) 
C 
至 于 边 状 目标 ， 该 结果 是 观测 者 应 得 的 ， 仅 当 
0 - 一 
Boag. = tan! c pac (21.45) 
cosa — —- 


21.15 仿生 声呐 


生物 声呐 的 成 功 应 用 ， 比 如 蝙蝠 和 海豚 ， 
引发 研究 者 们 基于 生物 声呐 形态 、 策 略 和 非 线性 处 理 
来 实现 声呐 。 生 物 声呐 所 展现 的 能 力促 使 研究 人 员 检 
查 仿效 生物 的 (仿生 的 ) 系统 。 

生物 声呐 形态 通常 有 单一 的 反射 器 和 一 对 接收 
器 。 蝙 申通 过 口 或 鼻 发 出 声 脉冲 ， 而 海豚 则 通过 气 才 
发 射 脉冲 。 两 个 接收 器 相当 于 耳 和 打 ， 人 允许 双 耳 声 处 
理 。 模 仿 的 双 耳 听觉 已 导致 用 于 定位 目标 ”和 扫描 
策略 中 中 的 小 型 阵列 的 出 现 。 对 蝙蝠 可 动 耳 廓 的 观 
察 促进 了 旋转 接收 器 的 研究 。 图 21.27 给 出 了 
这 样 一 个 例子 。 


图 21.27 中 心 发 射 器 侧面 与 旋转 接 
收 器 相 接 的 仿生 结构 声呐 


旋转 接收 器 让 其 轴线 落 到 反射 体 上 ， 不 仅 增加 检 
测 回 波 的 振幅 ， 而 且 增 大 其 带宽 ， 这 两 种 效果 均 能 改 
善 目标 分 类 能 力 。 

生物 声呐 策略 提供 了 成 功 定位 目标 的 线索 。 众 所 
周知 ， 换 能 器 波 束 内 的 目标 定位 可 影响 回 波 波形 ， 并 
使 目标 分 类 的 逆 问 题 变 得 复杂 "” 。 有 关 海豚 的 
影片 展示 了 它们 通过 双 耳 回声 处 理 在 一 个 可 重复 的 位 
置 和 距离 机 动 地 确定 目标 的 位 置 。 这 激发 了 模仿 海豚 
的 可 移动 声呐 的 研发 ， 该 声呐 被 安装 在 用 于 目标 分 类 
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传 


感 与 感知 


KI 


的 机 器 人 辟 上 "中 WE 21. 28 所 示 。 这 个 系统 能 
够 可 靠 地 区 分 一 枚 硬币 的 正 反 面 ， 但 只 能 在 引入 一 次 
标高 扫描 之 后 ， 标 高 扫描 是 为 了 适应 双 耳 听觉 所 造成 
的 这 种 定位 能 力 的 缺乏 。 标 高 扫描 的 想法 是 受 海豚 在 
搜寻 位 于 沙 地 下 的 猎物 时 所 展示 的 点 头 运 动 的 启发 而 
产生 的 。 


图 21.28 安装 在 机 器 人 臂 末 端 上 的 仿生 声呐 


另 一 个 有 用 的 策略 是 受 蝙蝠 发 出 的 探测 脉冲 所 局 
发 的 回 波 序列 处 理 。 作 为 大 多 数 声 呐 的 传统 “停止 
与 扫描 ”操作 的 一 种 扩展 ， 当 声呐 沿 着 分 段 线性 路 
径 移 动 以 显现 出 双 曲 线 趋势 时 ， 可 获得 声呐 数据 ， 该 
趋势 与 声 流 类 似 *…”i。 匹 配 数 据 以 符合 双 曲 线 趋势 ， 
可 以 估计 传送 距离 ， 从 而 有 助 于 避免 磁 撞 和 穿越 狭 罕 
的 通道 ”|。 

大 多 数 声呐 系统 使 用 经 典 的 估计 过 程 ， 涉 及 相关 
检测 和 频谱 分 析 。 耳 蜗 模 型 已 导致 用 多 带 通 滤波 央 去 
处 理 环境 地 标 分 类 中 的 宽带 脉冲 入 。 在 生物 神经 
系统 中 观察 到 的 动作 电位 尖峰 还 启发 了 基于 符合 探测 
技术 的 神经 形态 处 理 。 传 统 TOF DU te rd E BY Fs it 
信息 促进 了 声呐 探测 器 从 多 个 检测 中 提供 完整 的 回 波 
波形 信息 ， 这 些 多 个 检测 导致 了 尖峰 状 数据 的 产 
生 呈 人 且 国 。 对 脉冲 数据 运用 时 空 重合 技术 可 导致 混 
响 伪 影 识别 和 传送 距离 估计 。 

上 述 仿生 技术 对 于 回 波 中 存在 的 信息 
声呐 的 感 测 任 务 类 型 提供 了 一 些 见解 。 


量 和 最 适合 


总 结 


I^ =A 
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声呐 是 一 种 有 用 的 、 价 格 低廉 的 、 功 耗 低 的 、 重 
量 轻 和 简单 的 测 距 传感器 ， 为 机 器 人 技术 应 用 提供 精 
确 的 目标 定位 。 对 于 有 效 工 作 的 声呐 ， 理 解 其 物理 原 
理 和 实现 是 重要 的 ， 而 且 这 些 主题 已 经 包含 在 本 章 的 


前 面部 分 中 。 突 出 了 各 种 声呐 感 测 方法 ， 从 简单 的 单 
一 换 能 需 测 距 到 更 加 复杂 的 多 换 能 器 和 具有 关联 信和 号 
处 理 要 求 的 多 脉冲 配置 。 复 杂 的 声呐 能 够 精确 测量 目 
标 距 离 和 和 角度， 也 可 以 实现 目标 分 类 、 干 扰 抑 制 和 运 
动 补偿 。 声 呐 环 提供 周围 环境 覆盖 ，CTFM 系统 可 改 
善 检 测 小 反射 体 的 灵敏 度 。 正 在 进行 的 研究 所 涉及 的 
领域 包括 信号 与 数据 处 理 、 声 呐 地 图 构建 、 声 呐 配 
置 、 换 能 器 技术 和 仿生 声呐 ， 这 些 领 域 可 从 蜗 旺 和 海 
豚 所 使 用 的 生物 声呐 系统 中 得 到 启示 。 
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距离 传感器 是 一 种 从 自身 的 位 置 获取 其 周围 世 
界 三 维 结构 的 设备 。 通 常 它 测量 的 是 距 物 体 最 近 表 
看 的 深度 。 这 些 测 量 可 以 是 一 个 穿 过 扫描 平面 的 单 
个 点 ， 也 可 以 是 一 幅 在 每 个 像素 都 具有 深度 信息 的 
图 像 。 这 个 距离 信息 可 以 使 机 器 人 合理 地 确定 出 相 
对 于 该 距离 传 感 占 的 实际 环境 ， 从 而 允许 机 融 人 能 
更 有 效 地 寻找 导航 路 径 、 避 开 障碍 物 、 抓 取 物 体 和 
在 工业 零件 上 操作 。 
本 章 将 介绍 距离 数据 的 主要 表现 形式 (点 阵 ， 
由 三 角形 构成 的 面 和 三 维 像素 ) 以 及 从 距离 数据 
中 提取 有 用 特征 (平面 ， 直线 和 由 三 角形 构成 的 
Al) 的 主要 方法 。 也 将 介绍 获得 距离 数据 的 主要 
传感器 〈 第 22. 1 市 一 一 立体 激光 三 角 测 距 系 统 )， 
以 及 如 何 对 同一 景象 的 多 重 观测 ( 比如 来 自 移动 
中 的 机 器 人 的 数据 ) 进行 距离 配 准 (第 22.2 市 )， 
和 几 种 因 使 用 距离 数据 而 大 大 简化 任务 的 几 种 室内 
FELT BUM (5822.3 节 ) 。 
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22.1 距离 传 感 的 基础 知识 


此 节 我 们 将 介绍 以 下 内 容 : WD 有关 距离 图 像 数据 
的 基本 表现 形式 ; @ 关 于 在 机 器 人 应 用 中 不 太 常 用 的 
主要 的 三 维 传感器 的 简单 介绍 ; (3) 关于 比较 常用 的 基 
于 激光 的 距离 图 像 传感器 的 详细 描述 。 


22.1.1 距离 图 像 和 点 阵 


距离 数据 是 对 机 器 人 周边 景象 的 二 又 二 分 之 一 维 
或 三 维 描述 。 三 维 概念 的 出 现 是 因为 我 们 是 对 景象 中 
的 一 个 或 多 个 点 进行 (X，Y，2Z) 坐标 测量 。 通 常 在 
每 个 时 间 点 我 们 只 使 用 一 个 单 幅 距离 图 像 。 这 意味 着 
我 们 仅 能 观察 到 机 器 人 看 到 的 那 部 分 景象 一 一 物体 的 
前 面 。 换 名 话说， 我 们 观察 不 到 一 个 景象 所 有 侧面 的 
三 维 图 像 。 这 就 是 二 又 二 分 之 一 维 的 由 来 。 图 22. 1b 
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显示 的 是 一 幅 距 离 图 像 的 例子 而 图 22. 1a 显示 的 则 是 
幅 进行 了 反射 配 准 的 图 像 ， 其 中 的 每 一 个 像素 点 都 
记录 了 红外 线 的 反射 光 强 度 。 

表现 距离 数据 有 两 种 基本 的 格式 。 第 一 种 是 
距离 图 像 4(i, 7) ， 它 记录 了 图 像 中 的 每 个 像素 点 
(i, D 到 对 应 的 景象 点 (X,Y,，2Z) 的 距离 4。 通 
常 有 几 种 办 法 把 (i, j, d Ci, D) 映射 到 CX, 
Y, Z), ， 基 本 上 都 是 通过 使 用 距离 传感器 的 几何 学 
原理 。 图 22. 2 和 图 22.3 描绘 了 最 常用 的 映射 方 
法 。 在 这 里 给 出 的 方程 里 ，a 和 8B 是 针对 具体 传 感 
器 校正 的 值 。 

1) 正 交 法 。 这 里 (X, Y, Z) z (ai, Bj, di, j)). 
这 些 图 像 通常 来 自 于 距离 传感器 沿 x 和 y 方向 进行 平 
BA (ILEI 22. 2a)。 

2) 透视 法 。 这 里 4(i, jJ) 是 光线 沿 从 像素 点 
G, j) 到 点 (x, y, z) 的 视 距 。 把 此 距离 传感器 当 
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轴 则 平行 于 图 像 的 Ci, j) W, WA (X, Y, Z) = 
dli, D/ Vo? «Bf +f (oi, Bj, f), Erb f ditt 
学 系统 的 焦距 。 这 种 图 像 通常 来 自 于 集成 了 普通 亮度 
照相 机 的 传感器 设备 〈( 见 图 22.2b) 。 

3) 圆柱 法 。 在 这 里 ，d(i, j) 是 光线 沿 从 像素 
点 (i, fj) 到 点 (X, Y, Z) 的 视 距 。 在 这 种 情况 
下 ， 传 感 器 通常 旋转 着 扫描 x 轴 方 向 ,平移 着 扫描 y 
轴 方 向 。 这 样 ，(X，7，Z) = (d (i, j)sin(ai), Bj, 
d(i, j)cos(oi) ) ， 是 通常 的 变换 ( 见 图 22. 3a) 。 

4) BRIBE, XE, dli, j) 是 光线 沿 从 像素 点 
G, D 到 点 (X, Y, Z) 的 视 距 。 在 这 种 情况 下 ， 传 
感 器 通常 旋转 着 扫描 x 轴 方 向 ， 而 且 在 扫描 x 轴 方 向 
的 同时 也 在 y 轴 方 向 旋转 扫描 。 因 此 (i, j) 就 是 视 
线 的 方位 角 和 仰角 。 则 有 (X, Y, Z) =d(i, j) Ceos (Bj) 

b) sin(ai), sin(j) , cos(fj) sin(ai)) ( 见 图 22.3b) 。 
图 22.1 两 种 方法 分 别 得 到 的 图 像 

a) 配 准 的 红外 线 反射 图 像 
b) 距离 图 像 ， 距 离 越 近 的 点 越 暗 


图 像 面 


a) 
+Y 


Æ 22.3 不 同 的 距离 图 像 匹配 法 
a) 圆柱 法 b) 球形 法 


一 些 传感器 只 记录 了 平面 上 的 距离 ， 因 而 对 每 一 
MBAR i, AUR (x, z) 由 线性 图 像 4(i) 来 表示 。 


图 22.2 不 同 的 距离 图 像 匹 配 法 上 面 列举 的 正 交 法 、 透 视 法 和 圆柱 法 等 投影 方法 仍 适 
a) 正 交 法 b) 透视 法 用 于 这 种 简化 模式 。 


第 二 种 基本 格式 是 使 用 一 个 三 维 数据 点 的 列表 


"d 
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LOG, Y, ZD, ease HT Erud m Bt 
BUE. DETAR dCi, 7) 到 (X, Y, Z) mg 
换 后 ， 距 离 数 据 以 一 个 列表 的 形式 体现 。 有 关 精 确 映 
射 和 数据 格式 的 具体 内 容 以 商用 距离 传感器 提供 。 


22. 1.2 


立体 视觉 

许多 种 不 同 的 传感器 都 可 以 提供 距离 信息 ， 但 是 
仅 有 一 小 部 分 具备 大 多 数 机 器 人 应 用 需要 的 可 靠 性 。 
更 可 靠 的 传感器 ， 如 基于 激光 的 三 角 测 量 和 激光 雷达 
(LIDAR) 将 在 下 一 节 进 行 讨论 。 

实时 的 立体 信息 分 析 是 采用 两 个 或 更 多 的 图 像 作 
为 输入 来 预测 一 个 景象 中 的 点 的 距离 。 其 中 的 基本 概 
念 是 三 角 测 量 : 一 个 景象 点 和 它 的 两 个 照相 机 中 的 成 
像 点 形成 一 个 三 角形 。 如 果 已 知 两 个 相机 之 间 的 基线 
距离 和 相机 发 射 光 线形 成 的 夹 角 ， 到 物体 的 距离 就 可 
以 计算 出 来 。 

实际 上 ， 如 何 将 一 个 立体 成 像 系统 有 效 地 应 用 于 
机 器 人 系统 中 ， 还 存在 着 很 大 困难 。 大 多 数 困 难 来 自 
于 如 何 将 来 自 同一 个 景象 的 点 在 两 个 相机 中 的 成 像 匹 
配 起 来 。 更 深 一 层 的 顾虑 是 ， 立 体 分 析 在 机 器 人 里 的 
应 用 有 一 个 实时 的 限制 ， 而 许多 算法 需要 的 计算 能 
很 高 。 但 是 ， 近 年 来 各 方面 进展 很 快 ， 而 立体 成 像 的 
优势 就 在 于 它 能 提供 三 维 的 距离 图 像 。 这 种 图 像 和 距 
离 信 息 能 与 视觉 信息 配 准 ， 理 论 上 将 可 以 达到 无 限 远 
的 距离 ， 而 且 可 以 有 很 高 的 采样 率 ， 等 等 。 这 些 都 是 
其 他 距离 传感器 不 能 比拟 的 。 

在 这 一 小 节 里 ， 我 们 将 回顾 立体 成 像 分 析 的 基本 
算法 ， 并 将 着 重 介绍 立体 成 像 分 析 的 问题 和 潜能 。 

1. 立体 成 像 几何 

在 这 一 小 节 里 ,我 们 将 回顾 立体 分 析 的 基本 算 
法 ， 特 别 是 图 像 通 过 投射 和 再 次 投射 与 三 维 世 界 的 关 
系 。 关 于 牵涉 到 的 几何 知识 及 校正 过 程 的 更 深入 的 讨 
论 可 以 参阅 参考 文献 [22.2]. 

校正 输入 图 像 意 味 着 原始 图 像 经 过 修改 以 符合 一 
种 具有 特别 几何 形状 (如 图 22.4 所 示 ) 的 针眼 照相 
机 模型 。 任 意 一 个 三 维 点 5 沿 经 过 焦点 的 方向 投影 到 
图 像 上 的 一 点 。 如 果 两 个 相机 的 主 光学 轴 平 行 ， 成 像 
面 位 于 共同 的 平面 上 ， 并 且 具 有 在 同一 条 直线 的 扫描 
R, WARR (像素 点 进行 匹配 ) 所 用 的 几何 关系 
就 变 得 很 容易 。 核 线 定义 为 ， 在 左边 图 像 上 的 一 个 点 
s， 与 对 应 于 右边 图 像 上 具有 相同 纵 坐 标的 点 s' Hc [n] 
决定 的 一 条 扫描 线 。 因 此 ， 搜 索 立 体 匹配 的 像素 点 是 
线性 的 。 找 到 原始 图 像 的 校正 并 把 它们 转换 成 标准 格 
式 的 整个 过 程 称 为 校准 ， 其 详细 讨论 见 参 考 文献 
[22.2]. 


图 22.4 理想 化 的 立体 成 像 几何 模型 
图 22.4 中 ， 全 局 坐标 系 的 原点 位 于 左边 照相 机 的 焦点 
(相机 中 心 ) 。 坐 标 系 是 一 个 右手 系统 ，2 轴 正 方向 指 
向 照相 机 前 边 ， 而 立轴 正方 向 指向 右边 。 相 机 的 主 光 
学 轴 穿 过 成 像 面 ， 坐 标 为 〈C,，C, ) ， 两 个 相机 都 是 


如 此 (有 一 种 非 平 行 轴 双 目 立 体 视觉 照相 机 的 变形 允 
许 两 个 C, 不 同 ) 。 两 个 相机 的 焦距 也 相同 。 图 像 排 成 
一 线 ， 任 何 景象 点 投射 到 成 像 面 的 坐标 都 具有 关系 
y=y'。 沿 x 轴 的 差别 定义 为 视差 。 焦 点 之 间 的 向 量 与 
并 轴 一 致 ， 参 见 参考 文献 [22.1]. 


点 s 和 s' 的 x 坐标 的 差 就 是 此 三 维 点 5 的 视差 。 


视差 与 该 三 维 点 到 焦点 的 距离 ， 以 及 两 个 焦点 间 的 距 
离 一 一 基线 7 相关 。 
一 个 三 维 点 可 以 投影 到 或 左 或 右面 的 图 像 中 ， 方 


法 是 在 一 个 统一 的 坐标 系 内 使 用 一 个 投影 矩阵 进行 矩 
阵 乘法 和 运算。 此 三 维 点 的 坐标 是 在 左边 照相 机 (UL 
图 22.4) 的 坐标 系 内 定义 的 。 
F, 0 C, -FJT, 
Pa) 0) F, C, 0 
0 0 1 0 
这 是 单个 照相 机 的 投影 矩阵 。F, 和 分别 是 纠正 后 
图 像 的 焦距 ， 而 CRI C, 则 分 别 是 光线 中 心 。X 是 相 
对 于 左边 (参考) 照相 机 的 相机 位 移 。 对 左边 相机 
来 说 7 是 0; 而 对 于 右边 的 相机 来 说 ， 它 就 是 基线 和 
x 轴 向 的 焦距 乘积 。 
一 个 三 维 的 点 在 统一 的 坐标 系 中 的 坐标 通过 使 用 
矩阵 相 乘 的 投影 得 来 ， 


X 
X 

Bb 

2 Z 
P4 

1 


(22.1) 


(22.2) 
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AP, (s/w, y/w) 是 理想 化 的 图 像 坐标 。 

如 果 左 右 两 边 的 图 像 点 对 应 于 同一 个 景象 中 的 特 
征 ， 该 特征 的 深度 可 以 使 用 再 投影 矩阵 从 图 像 点 的 坐 
标 计算 出 来 ， 


10 0 = 
01 0 at 

Qe a N (22.3) 
0 0 -LT (C,-C,)/T, 


式 中 ， 有 撒 号 的 参数 来 自 左边 照相 机 的 投影 矩阵 ， 而 
无 撤 号 的 参数 则 来 自 右 边 。 除 平行 轴 双 目 立体 视觉 昭 


相机 外 ,最 后 一 项 通常 为 零 。 如 果 (x, y) 和 
(x', y) 是 匹配 的 两 个 像素 点 ， | 有 d=x-x', PRA 
X x 
Y) j|» 
r9, (22.4) 

W. 1 


AP, (XW, Y/W, Z/W) 是 景象 特征 的 坐标 ; d= 
x 一 x' 为 视差 。 假设 C, = C'， 那么 距离 Z 呈现 相似 的 
三 角 测 量 的 逆 形 式 


Z- (22. 5) 
d 

再 投射 仅仅 对 于 纠正 后 的 图 像 适用 ， 一 般 情况 下 ， 投 
影 的 直线 并 不 相交 。 视 差 d 是 道 深度 测量 ， 而 向 量 
(x, y, d) 则 是 距离 图 像 的 透视 法 表述 (参见 第 
22.1.1 节 )， 有 时 候 也 称 为 视差 空间 表示 法 。 作 为 一 
种 更 有 效 的 决定 障碍 物 或 其 他 特征 的 表述 形式 ， 视 差 

空间 常常 用 于 非 三 维 应 用 里 (参见 第 22.3.3 节 )。 
式 (22.4) 体现 了 视差 空间 与 三 维 几 何 空 间 的 


单 应 性 。 视 差 空间 在 三 维 坐 标 系 的 变换 中 也 很 有 用 。 
假设 mm = (xy, yo, dy, 1) 在 坐标 系 0 里面， 而 经 过 
刚性 移动 (R, t) 来 到 坐标 系 1。 使 用 再 投射 方程 


(22.4) 则 有 三 维 位 置 为 Om 。 在 刚性 移动 的 条 件 下 
wa o. 最 后 再 应 用 O-: 得 到 在 坐标 系 1 中 
的 视差 表示 形式 。 将 这 些 操作 串联 起 来 就 是 单 应 性 的 


体现 
(Rk t 
H(R,t) =O (o p (22.6) 
考 系 中 的 


使 用 单 应 性 可 以 不 需要 转换 三 维 点 就 能 将 参 
点 直接 投影 到 男 一 个 坐标 系 中 。 

2. 立体 成 像 方法 

立体 成 像 分 析 的 基本 问题 是 匹配 图 像 中 代表 同一 
个 物体 或 者 部 分 物体 的 元 素 。 当 匹配 完成 以 后 ， 到 该 
物体 的 距离 就 能 通过 图 像 的 几何 关系 计算 出 来 。 


匹配 方法 可 以 根据 特征 区 分 为 局 部 或 者 全 局 的 。 
局 部 的 方法 试图 基于 一 个 图 像 里 面 的 小 块 区 域 的 内 
在 特征 与 男 一 个 图 像 进 行 匹配 。 全 局 方法 会 考虑 诸 
如 表面 的 连续 性 或 者 底部 的 支持 等 物理 限制 ， 并 以 
此 扩展 局 部 方法 。 局 部 方法 可 以 进一步 区 分 为 试图 
匹配 图 像 中 不 连续 的 特征 还 是 去 关联 一 小 块 区 
BaF) 。 局 部 方法 通常 会 选取 不 取决 于 光照 条 件 和 
观测 角度 的 特征 ， 例 如 和 角落。 角落 就 是 一 种 可 以 自 
然 可 供 使 用 的 特征 ， 因 为 在 几乎 任何 投影 中 它们 依 
然 保持 角落 的 形状 。 基 于 特征 的 算法 会 补偿 观测 角 
度 的 变化 和 相机 的 差别 ， 因 而 可 以 产生 快速 、 鲁 棒 
的 匹配 。 但 是 这 种 算法 同样 具有 一 些 劣势 ， 诸 如 可 
能 需要 提取 代价 高 昂 的 特征 以 及 只 能 产生 稀 玖 的 距 
离 结果 。 

因为 局 部 区 域 关 联 是 实时 立体 成 像 里 面 最 有 效 和 
实际 的 一 种 算法 ， 在 下 一 节 我 们 将 做 进一步 详细 介 
绍 。 参 考 文献 [22.5] 是 关于 最 近 的 立体 成 像 方 法 
的 一 个 调查 和 结果 。 该 论文 的 作者 也 维护 了 一 个 网 页 
来 列举 出 关于 立体 成 像 方 法 的 最 新 信息 ， 见 参考 文献 
[22.6]. 

3. 区 域 关 联 立 体 成 像 

区 域 关 联 使 用 关联 方法 去 比较 不 同 图 像 里 的 小 块 
区 域 。 因 为 小 块 的 区 域 更 有 可 能 随 着 观测 角度 的 不 同 
而 在 不 同 图 像 里 面相 似 ， 而 大 块 的 区 域 则 提高 了 信和 噪 
比 ， 区 域 的 大 小 就 需要 折 中 了 。 相 较 于 基于 特征 的 方 
法 ， 基 于 区 域 关 联 的 方法 则 产生 比较 密集 的 结果 。 因 
ee em ea KE oka 
算法 结构 ， 人 们 通常 在 实现 这 种 方法 时 可 以 进 
优化 。 

典型 的 区 域 关 联 方法 具有 五 个 步骤 ( 见 图 22.5) , 


TER 


gine mesm Kme 过 滤 后 的 
EX b MERG 


图 22.5 立体 成 像 的 基本 处 理 过 程 
(详细 内 容 参 见 参 考 文献 [22. 4 ]) 


1) 几何 关系 校正 。 在 这 个 步 又 ， 作 为 输入 的 图 
像 里 的 变形 失真 ， 采 用 弯曲 而 变 成 标准 形式 的 方法 来 
进行 校正 。 

2) 图 像 变 形 。 一 个 局 域 算 子 将 灰 度 图 像 中 的 每 
一 个 像素 转换 为 一 种 更 适合 ( 处理 ) 的 形式 ， 比 如 ， 
基于 局 部 的 平均 像素 强度 进行 像素 的 标准 化 。 
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3) 区 域 关 联 。 这 一 步 就 是 关联 步骤 。 在 此 步 
了 又， 每 一 个 小 块 区 域 在 搜索 窗口 里 与 其 他 区 域 进行 
比较 。 

4) 提取 极 值 。 在 每 一 个 像素 都 有 一 个 关联 极 值 
提取 出 来 ， 从 而 产生 了 一 个 视差 图 像 : 每 个 像素 值 都 
是 比较 左右 图 像 块 得 到 最 佳 匹配 的 视差 。 

5) 后 滤波 。 使 用 一 个 或 多 个 滤波 器 来 清除 所 得 
视差 图 像 中 的 噪声 。 

光照 情况 、 透 视 情况 和 不 同 图 像 之 间 的 差异 都 会 
对 图 像 区 域 的 关联 造成 干扰 。 因 此 ， 区 域 关联 法 通常 
进行 的 弥补 方式 是 对 某 种 变形 图 像 的 像素 强度 ， 而 不 
是 原始 图 像 的 像素 强度 进行 关联 。 假 设 u,v 是 需 
关联 图 像 的 中 心 像素 ， x， y 是 u,v 周边 的 像素 , d 
是 视差 ， 而 s. ,分 别 是 左右 图 像 的 像素 强度 。 

1) 归 一 化 的 交叉 相关 性 。 


Y L, n 1,.] LE 3s 7 T1245] 


y 


JA liye. ts, 20a 
2) 高 通 滤波 器 如 高 斯 调和 量 算 子 (LOG), 在 
些 使 用 高 斯 算 子 平滑 过 的 区 域 ， 调 和 算 子 ( 即 拉 
普 拉 斯 算 子 ) 测量 其 中 定向 边缘 的 密度 。 通 常 高 其 
标准 差 是 一 两 个 像素 
5 s(log, , -log, 4,) 


AP, s(x) Aba AG || x ll, lg, Æ EBZK (x, y) 
处 的 高 斯 调和 量 算 子 。 

3) 非 参 数 。 这 些 变换 试图 处 理 异常 值 的 问题 ， 
而 这 些 异 常 值 会 试图 完全 颠 黎 关 联 测量 ， 尤 其 是 在 使 
用 方差 的 时 候 。 参 考 文献 [22.7] 里 提出 的 统计 方 
法 通过 计算 一 个 位 向 量 来 描述 一 个 像素 的 局 部 环境 ， 
而 关联 测量 就 是 两 个 向 量 之 间 的 哈 明 ( Hamming) 
距离 


E Uo, DUC >,) 

针对 一 些 标准 图 像 各 种 变换 的 结果 及 误差 率 详 见 
参考 文献 [22.6], 

另 一 种 增加 匹配 信 噪 比 的 技术 是 使 用 超过 两 个 图 
像 进 行 (匹配 )'?。 这 种 技术 还 能 克服 观测 角度 被 
遮挡 的 问题 ， 在 这 种 情况 下 ,需要 匹配 的 物体 的 部 分 
可 能 没有 出 现在 另 一 个 图 像 中 。 一 种 增加 图 像 在 相同 
视差 下 的 关联 性 的 简单 技术 似乎 也 能 工作 得 很 
好 2。 显然 ,使 用 多 个 图 像 (进行 匹配 ) 的 计算 
支出 要 大 于 仅 使 用 两 个 图 像 。 


”视差 为 4d。 一 一 译 者 注 


密集 的 距离 图 像 通常 包含 错误 的 匹配 ， 需 要 清除 
掉 ， 尽 管 对 使 用 多 个 图 像 的 方法 来 说 这 通常 不 成 为 问 
题 。 表 22. 1 列举 出 在 文献 中 找到 的 已 经 经 过 讨论 的 
JA VE BEAT o 

视差 图 像 经 过 处 理 可 以 给 出 亚 像素 精度 ， 其 方法 
是 找 出 像素 间 的 关联 峰值 。 这 就 在 不 需要 更 多 工作 量 
的 基础 上 增加 了 可 用 的 距离 分 辨 率 。 典 型 的 精度 是 像 
素 的 十 分 之 一 。 


表 22.1 在 区 域 关联 中 清除 错误 匹配 的 后 滤波 技术 
关联 表面 法 参考 文献 [22.10] 
峰值 宽度 宽 的 峰值 代表 差 的 特征 定位 
峰值 高 度 低 的 峰值 指示 较 差 的 匹配 
件数 多 个 峰值 说 明了 结果 模棱两可 
模式 滤波 器 缺乏 支持 视差 导致 平滑 度 受 损 
左 / 右 检验 01601 | 非 对 称 匹配 指示 观测 角度 的 遮挡 
纹理 [20 13] 较 低 的 纹理 能 量 造 成 较 差 的 匹配 


4. 立体 距离 的 质量 

多 种 人 为 因素 和 问题 会 影响 立体 距离 图 像 的 
质量 。 

1) 拖 尾 效应 。 区域 关联 会 引起 前 景物 体 的 延伸 
而 造成 模糊 ， 例 如 图 22.6 中 妇女 的 头 部 。 原 因 是 物 
体 与 背景 形成 的 明显 的 边缘 的 主导 性 。 非 参数 测量 较 
少 受 这 种 现象 的 影响 。 其 他 手段 包括 多 重 关 联 窗口 和 
塑 形 窗口 等 。 

2) 失落 效应 。 这 些 产 生 于 因为 缺少 足够 的 纹理 
能 量 而 造成 不 能 找到 好 的 匹配 的 区 域 。 失 落 效应 通常 
产生 在 室内 外 人 造 表面 上 。 而 投射 一 块 随机 红外 纹理 
通常 可 以 帮助 解决 这 类 问题 字 中。 

3) 距离 精度 。 不 像 激 光 雷 达 设 备 (LADAR), 
立体 成 像 的 精度 是 距离 的 二 次 方程 ， 可 以 通过 对 式 
(22. 5) 中 视差 求 导 而 得 


P 


ô=- (22.7) 
而 这 种 立体 距离 图 像 随 距离 的 增 大 而 趋 恶劣 的 情 


况 可 以 在 图 22.6 里 面 的 三 维 重 建 中 清楚 地 看 到 。 

4) 处 理 运算 。 区 域 关联 需要 的 处 理 运算 非常 密 
集 。 需 要 的 计算 量 是 Awd 次 运算 ， 其 中 A 是 图 像 面 
积 ，vw 是 关联 窗口 尺寸 而 d 是 视差 的 数量 。 明 智 的 优 
化 可 以 利用 宛 余 计算 来 减少 计算 量 至 Ad 次 (与 窗口 
尺寸 无 关 ) ， 当 然 要 以 一 定 的 存储 空间 为 代价 。 实 时 
运算 可 以 在 诸如 标准 个 人 电脑 (PCs) 7177, EUER 
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图 22.6 一 个 室外 花园 景象 的 立体 成 像 结 果 的 例子 
(照相 机 的 基线 长 9 厘米 ) 
a) 原始 左 图 像 b) 从 不 同 角度 计算 出 来 的 三 维 点 
c) BEDAE C, 5 PU LIS RNR 站 


BEAR? 617) 、 数 字 信和 号 处 理 器 (DSPs). HLH AY 
编程 门 阵列 (FPGA) 7*9 和 特别 的 专用 集成 电路 
(ASIC) 中 等 等 不 同 的 装置 上 实现 。 

5. 其 他 来 自视 觉 源 的 距离 信息 

在 此 我 们 列举 出 最 常用 的 、 但 不 太 可 靠 的 其 他 来 
自视 觉 源 的 距离 信息 。 这 些 方法 通常 潜在 着 与 其 他 传 
感 技术 互补 使 用 的 可 能 性 。 

1) 聚集 / 散 焦 。 对 有 关照 相机 参数 的 认 知 和 图 
像 特征 的 模糊 度 可 以 让 人 们 佑 算出 对 应 的 景象 特征 到 


理想 焦距 的 距离 ”1 。 传 感 器 可 以 是 被 动 的 〈 如 使 
用 预先 拍摄 的 图 像 ) 或 者 主动 的 〈 以 不 同 的 焦距 设 
置 抓拍 几 个 图 像 ) 。 

2) 机 构 与 运动 。 机 构 与 运动 算法 同时 计算 三 维 
景象 的 结构 和 照相 机 的 运动 轨迹 '”  。 基 本 上 这 是 
一 个 双 目 镜 立 体 成 像 过 程 (参考 之 前 的 讨论 )， 只 不 
过 使 用 的 是 单个 运动 的 相机 。 双 目镜 立体 成 像 所 需要 
的 图 像 是 通过 同一 个 相机 在 不 同 的 位 置 拍摄 的 。 视 频 
摄像 机 也 可 以 应 用 于 这 一 算法 ， 只 是 图 像 分 辨 率 比较 
低 。 此 算法 优 于 一 般 算 法 的 一 个 重要 方面 是 ， 如 果 不 
同 帧 的 图 像 之 间 的 时 间或 者 相机 的 运动 足够 小 ， 图 像 
中 的 特征 可 以 轻易 被 追踪 。 这 就 简化 了 对 应 问题 ,但 
却 导致 了 另 一 个 问题 。 如 果 拍 摄 一 对 用 于 立体 成 像 测 
量 的 图 像 之 间 的 时 间 太 靠近 的 话 ， 这 两 幅 图 像 之 间 的 
间隔 就 很 小 ， 从 而 导致 了 一 个 短 基线 。 三 角 测 量 计算 
将 会 很 不 准确 ， 因 为 在 预测 图 像 特征 位 置 时 产生 的 误 
差 会 造成 三 维 位 移 预 测 (尤其 是 深度 预测 ) 的 很 大 
错误 。 这 个 问题 可 以 通过 进行 较 长 时 间 的 追踪 来 避 
免 。 第 二 个 问题 是 ， 并 不 是 所 有 的 运动 都 适用 于 整个 
三 维 景象 结构 的 预测 。 例 如 ， 如 果 摄 像 机 仅 围 绕 它 的 
光学 轴 或 者 焦点 转动 ， 那 么 将 不 能 够 产生 任何 三 维 信 
息 以 供 恢复 。 小 心 一 点 即 可 以 避免 这 个 问题 。 

3) 阴影 。 一 块 面 上 的 阴影 与 这 个 面 与 观测 者 和 
光源 的 方位 角 相 关 。 这 种 相关 性 可 以 用 以 估算 横 过 表 
面 的 方位 角 ， 并 且 可 以 与 表面 法 线 相 融 合 以 预测 相关 
表面 的 深度 。 

4) 光度 立体 成 像 。 光 度 立 体 成 像 ”| 是 对 阴影 
和 立体 处 理 的 一 种 综合 。 其 关键 概念 是 物体 的 阴影 
光源 位 置 的 变化 而 不 同 。 因 此 ， 如 果 你 有 了 一 个 物体 
或 景象 在 不 同 光 源 位 置 ( 比如 太阳 的 移动 ) 条 件 下 
的 几 个 排列 好 的 图 像 ， 那 么 景象 面 的 法 线 就 可 以 计算 
出 来 了 。 通 过 法 线 的 估算 ,相关 面 的 深度 就 可 以 预测 
了 。 对 这 一 种 方法 来 说 ， 观 测 者 的 位 置 需要 静止 而 光 
源 的 位 置 需要 改变 ， 这 些 限制 导致 它 对 大 多 数 机 器 人 
应 用 来 说 不 太 有 效 。 

5) 纹理 。 在 一 个 面 上 统一 的 纹理 或 统计 学 纹理 
变化 的 方式 与 该 面相 对 于 观测 者 的 方位 角 相 关 。 像 阴 
影 一 样 ,纹理 的 梯度 可 以 用 以 估算 横 过 面 的 方位 
角 ”“”， 并 且 可 以 与 表面 法 线 相 融 合 以 预测 相关 面 
的 深度 。 


22.1.3 基于 激光 的 距离 传感器 


常用 的 基于 激光 的 距离 传感器 有 三 种 : 
1) 三 角 测 量 传感器 ; 
2) 相位 调制 传 感 需 ; 
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3) 飞行 时 间 传 感 器 。 

这 些 传感器 在 下 文 都 将 详细 讨论 。 除 此 之 外 ， 还 
有 激光 多 普 勒 和 激光 干涉 距离 传感器 ， 但 是 这 两 种 仪 
器 目前 应 用 不 广 ， 我 们 在 这 里 不 进行 讨论 。Blais 发 
表 了 一 篇 回顾 距离 传感器 的 优秀 论文 己 20 ， 可 以 进 
行 参阅 。 

其 实 ， 下 面 要 讨论 的 这 三 种 传感器 的 物理 原理 并 
不 是 非得 依靠 激光 的 使 用 一 一 其 实 任何 光源 都 可 以 工 
作 。 但 是 激光 的 使 用 是 最 传统 的 ， 这 是 因为 : 激光 
可 以 使 用 轻便 发 光源 来 产生 强 光 束 ，@ 红 外 光 的 使 用 
不 受 干扰 ; 图 激光 汇聚 性 好 ， 可 以 形成 很 窗 的 光束 ; 
图 单一 频率 的 光源 可 以 轻易 滤 除 不 想 要 的 频率 ; @ 单 
一 频率 的 光线 不 像 全 光谱 的 光线 经 过 折射 后 会 散 开 ; 
@ 半 导体 装置 可 以 轻易 产生 短 脉 冲 的 光线 ， 等 等 。 

这 三 种 传感器 类 型 有 一 个 优势 ， 在 于 距离 图 像 通 
常 可 以 获得 一 个 匹配 的 反射 系数 图 像 。 通 过 对 激光 光 
束 的 强度 经 物体 表面 反射 后 减少 幅度 的 测量 ， 便 可 以 
估算 该 物体 表面 的 反射 系数 。 这 仅仅 是 单一 频率 激光 
的 反射 系数 ， 但 是 ， 它 提供 了 该 表面 外 表 的 有 用 信息 
(同时 表面 形状 的 测量 经 由 距离 测量 得 到 ) 。 三 色 激 
光 系 统 玉 下 用 一 种 相似 的 方式 给 出 了 配 准 的 红 - 绿 - 
蓝 (RGB) 彩色 图 像 。 图 22. 1 显示 了 来 自 同一 景象 
的 进行 配 准 了 的 距离 和 反射 系数 的 图 像 。 
这 三 种 传感器 类 型 也 有 一 个 劣势 ， 那 就 是 镜面 反 
射 。 通 常 的 假设 是 被 观测 的 光线 是 来 自 物体 表面 的 漫 
反射 光 。 如 果 被 观测 的 表面 是 镜面 质地 的 ， 比 如 抛光 
的 金属 或 水 面 ， 那 么 照射 光 就 会 从 预测 不 到 的 方向 反 
射 开 。 如 果 传 感 器 的 接收 器 最 终 探测 到 了 一 些 反射 
光 ， 那 么 将 很 可 能 造成 不 正确 的 距离 测量 。 镜 面 反射 
就 好 像 发 生 在 表面 的 折线 边界 一 样 。 
第 二 个 问题 是 激光 的 足迹 。 因 为 激光 光束 有 一 定 
的 宽度 ， 但 它 投射 到 物体 的 边缘 时 ， 部 分 光线 其 实 投 
射 到 了 更 深 的 面 上 S 。 这 种 现象 的 结果 取决 于 传感器 
本 身 ， 但 通常 会 导致 测量 到 的 距离 落 于 两 个 面 之 间 。 
这 种 测量 其 实 暗示 出 这 种 距离 来 自 一 个 空洞 的 空间 。 
一 些 来 自明 显 空洞 的 噪声 容易 过 滤 掉 ， 但 是 错误 的 测 
量 也 可 能 来 自 于 距离 真实 面 很 近 的 地 方 ， 从 而 很 难 被 
清除 。 


22.1.4 基于 飞行 时 间 的 距离 传感器 


基于 飞行 时 间 的 距离 传感器 是 这 样 工 作 的 : 它们 
计算 一 束 光 从 光源 到 目标 物体 再 反射 到 接收 器 CB 
常 与 光源 并 列 放置 ) 所 用 的 时 间 ， 从 而 得 到 距离 。 


日 “该 物体 后 面 。 一 一 译 者 注 


从 某 种 意义 来 说 ， 它 们 是 基于 光 的 雷达 传感器 。 飞 行 
时 间 乘 以 光 的 速度 (在 给 定 的 媒介 一 一 如 太空 、 空 
气 或 水 一 一 并 根据 媒介 的 密度 和 温度 进行 调整 ) 得 
到 距离 。 基 于 激光 的 飞行 时 间距 离 传感器 也 被 称 为 光 
线 探测 测 距 仪 (LIDAR) 或 激光 雷达 (LADAR) f£ 
感 器 。 

这 些 传感器 的 精度 限制 取决 于 能 测量 的 最 小 时 间 
(从 而 算出 能 测量 到 的 最 小 距离 )、 接 收 器 的 时 间 精 
度 (或 量化 ) 和 激光 脉冲 的 时 间 宽 度 。 

很 多 用 于 局 部 测量 的 基于 飞行 时 间 的 传感器 具有 
称 为 模糊 性 间隔 的 性 质 ， 间 隔 可 长 达 20m。 传 感 器 周 
期 性 发 射 光 脉冲 ， 从 返回 的 脉冲 所 用 的 时 间 算 出 目标 
平均 的 距离 。 为 了 限制 反射 噪声 并 简化 探测 所 用 的 电 
子 装置 ， 很 多 传感器 只 能 接收 到 达 时 间 在 Ac 之 内 的 
信号 ， 但 是 在 这 个 时 段 内 接收 器 也 可 能 接收 到 来 自 之 
前 发 射 的 脉冲 从 更 远 的 物体 反射 的 信号 。 这 就 意味 着 
一 个 距离 测量 Z 对 多 个 cAt/2 分 辨 不 清 ， 因 为 来 自 比 
cAt/2 更 远 〈 比 如 z) 的 面 被 记录 为 z 除 以 cAt/2 得 到 
的 余数 。 因 此 对 平滑 面 的 距离 测量 可 以 增加 到 cAw/2 
然后 变 为 0。 通常 cAt/2 的 值 是 20 ~ 40m。 在 光滑 的 
表面 ， 比 如 地 面 或 路 面 ， 利 用 距离 的 变化 是 平滑 的 假 
dx, 使 用 一 种 展开 算法 可 以 得 到 距离 的 真实 值 。 

大 部 分 基于 飞行 时 间 的 传感器 只 发 射 一 束 光 ， 这 
样 距离 测量 只 能 从 一 个 单个 的 点 获得 。 机 器 人 应 用 通 
常 需要 更 多 的 信息 ， 这 样 距离 数据 通常 以 平面 上 的 面 
的 距离 行 向 量 ( 见 图 22.7) 或 者 一 幅 图 像 ( 见 图 
22.1) 表示 。 为 了 获得 这 些 更 密集 的 数据 表示 法 ， 激 
光 光 束 向 景象 扫描 。 通 常 通过 使 用 一 系列 的 镜子 的 方 
式 ， 而 不 是 直接 移动 激光 器 和 探测 器 来 完成 扫描 
(镜子 更 轻 也 更 不 容易 因为 运动 而 造成 损伤 )。 这 里 
最 常用 的 技术 是 使 用 一 个 步 进 电动 机 (以 进行 可 编 
程控 制 的 距离 传 感 ) 或 旋转 或 振荡 镜子 以 达到 自动 
扫描 。 

对 适合 机 器 人 的 应 用 来 说 ， 标 准 陆 基 的 基于 飞行 
时 间 的 传感器 具有 10 ~ 100m 的 测 距 能 力 ， 以 及 5 ~ 
10mm 的 精度 。 能 扫描 的 景象 的 快慢 取决 于 镜子 的 扫 
描 频 率 和 脉冲 频率 ， 但 每 秒 1 ~ 25 千 点 是 很 典型 的 速 
度 。 这 种 传感器 的 制造 商 包 括 Acuity，SICK，Mensi， 
DeltaSphere 和 Cyrax。 

最 近 ， 一 种 新 型 的 基于 飞行 时 间 的 传感器 被 开发 
了 出 来 ， 称 为 快 闪 激光 雷达 。 关 键 创新 是 在 传感器 芯 
片 每 个 像素 中 包括 了 计时 电路 。 这 样 ， 每 一 个 像素 就 
能 测量 从 该 像素 的 视线 方向 来 的 光 脉 冲 被 探测 到 的 时 
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距离 (绝对 值 单 位 ) 


-90 0 +90 
EC) 
Æ 22.7 理想 化 的 一 维 距离 数据 的 
图 像样 本 与 观测 角 之 间 的 关系 图 


间 。 这 就 允许 了 在 每 个 像素 点 同时 进行 距离 测量 。 这 
种 情况 下 ， 光 脉冲 必须 扫 过 被 观测 的 整个 景象 ， 因 而 
通常 使 用 的 传感器 是 一 个 阵列 红外 激光 发 光 二 极 管 


传感器 激光 器 
图 22.8 使 用 一 个 激光 点 的 三 角 测 量 法 


实际 优越 性 。 
1) 已 知 频率 的 激光 (例如 733nm) 可 以 与 一 个 


(LEDs)。 尽 管 这 种 传感器 的 空间 分 辨 率 小 于 当前 的 
照相 机 (如 只 有 64 x64, 160 x 124, 128 x128), 但 
是 数据 采样 率 可 以 达到 摄像 机 级 别 (30 ~ 50fps) ， 同 
样 可 以 提供 足够 机 器 人 使 用 的 反馈 数据 量 。 不 同 的 传 
感 器 测 距 能 力 已 经 报道 ， 比 如 最 长 5m'*” (同时 距 
离 的 标准 差 在 5 ~ 50cm 之 间 ， 值 随 目 标的 距离 和 方 
向 的 不 同 而 不 同 ) BR km” (没有 收 到 关于 标 
准 差 的 报告 ) o 


22.1.5 调制 距离 传感器 


调制 距离 传感器 通常 有 两 种 ， 取 决 于 连续 的 激光 
言 号 是 调幅 还 是 调频 。 通 过 观测 发 射 和 接收 信号 的 相 
位 差 ， 信 和 号 的 传输 时 间 以 及 到 目标 的 距离 得 以 测 出 。 
但 信号 相位 每 2 进行 重复 ， 因 而 这 些 传 感 器 存在 模 
糊 性 间隔 。 

这 些 传感器 产生 一 种 必须 进行 扫 频 的 单个 光束 。 
扫描 距离 可 以 达到 20 ~ 40m 而 准确 率 是 5mm。 图 
22. 1 就 是 来 自 一 个 调制 传感器 的 扫描 结果 。 


22.1.6 基于 三 角 测 量 的 距离 传感器 


基于 三 角 测 量 的 距离 传感器 ”使 用 的 基本 原 
理 与 前 面 讨论 过 的 立体 成 像 传感器 相似 。 关 键 概念 在 
图 22. 8 中 描述 : 一 束 激光 从 一 个 位 置 投 射 到 被 观测 
表面 。 产 生 的 光 点 被 位 于 第 二 个 位 置 的 传感器 接收 
到 。 知 道 了 激光 和 传感器 的 相对 位 置 和 方位 ， 再 加 上 
一 些 简单 的 三 角 法 则 就 能 计算 被 照射 的 表面 点 的 三 维 
位 置 了 。 这 种 三 角 测量 方法 在 激光 发 射 点 的 位 置 精确 
测量 的 条 件 下 更 为 准确 ， 通 常 可 以 达到 0. 1 个 像素 的 
xg 29] : 

因为 激光 的 照度 是 可 控 的 ， 这 种 方法 有 下 面 几 点 


[Ea 


TX PER E FH In] Vi 8 JG E ROCA UU BO (cd vá 
为 Snm) 。 这 就 允许 了 对 光 点 唯一 性 的 辨认 ， 因 为 可 
以 基本 上 滤 除 其 他 所 有 的 强 光 ， 使 激光 点 成 为 图 像 中 
最 强 的 光源 。 

2) 激光 点 可 以 使 用 透镜 和 镜子 进行 重 塑 从 而 制 
造 出 多 个 点 或 者 光 带 ， 因 而 使 多 个 三 维 点 的 同时 测量 
成 为 可 能 。 通 常 使 用 的 是 光 带 ， 是 因为 光 带 可 以 扫描 
遍及 景象 以 观测 整个 景象 (如 图 22.9 所 示 )。 其 他 
的 照射 模式 也 广泛 使 用 着 ,例如 平行 线 、 同 心 圆 、 交 
叉 线 和 点 阵 等 。 商 用 的 结构 光 模 式 发 生 器 可 以 从 
Lasiris 或 者 Edmunds Optics 公司 获得 。 


旋转 镜 
图 22.9 一 个 覆盖 大 片 景象 的 扫 频 激光 面 


3) 激光 射线 可 以 通过 计算 机 编程 控制 的 镜子 来 
选择 性 地 扫描 给 定 的 区 域 ,例如 门廊 或 潜在 的 障碍 
Wy, 或 者 需要 抓 取 的 物体 等 。 

当然 这 种 方法 的 缺点 包括 : 

1) 使 用 的 激光 强度 导致 潜在 的 眼睛 安全 威胁 ， 
特别 是 激光 频率 在 不 可 见 光 的 范围 内 (通常 是 红外 
光 区 域 ) 。 

2) 从 金属 或 麻 光 物体 表面 的 镜面 反射 ， 可 以 造 
成 激光 照射 得 到 的 不 正确 距离 测量 ， 如 图 22. 10 所 
示 ， 测 量 到 的 假想 面 其 实在 真实 表面 之 后 。 
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传感器 
反射 面 


发 生 镜面 反 
射 的 实际 面 


o" 
计算 面 
图 22.10 镜面 反射 导致 的 不 正确 的 深度 估算 


22.1.7 传感器 举例 


一 种 典型 的 基于 相位 调制 的 距离 传感器 是 Zohler 
and Frohlich 25200。 这 是 一 种 昂贵 的 球形 扫描 传 感 
器 ， 可 以 覆盖 整个 360? 的 水 平 扫描 面 和 15$" 的 垂直 
扫描 面 。 每 一 次 扫描 用 时 约 100s， 可 以 获得 多 达 
20000 个 水 平方 向 的 三 维 点 和 8000 个 垂直 方向 的 三 
维 点 。 扫 描 准 确 性 取决 于 仪器 到 目标 的 距离 ， 在 采样 
角度 间隔 是 0.01" (这样 采样 之 间 的 距离 间隔 则 是 
1.7mm/10m) 的 情况 下 可 以 达到 4mm。 密 集 的 数据 
通常 用 于 三 维 景象 测绘 、 建 模 和 虚拟 现实 重建 。 

款 通 常用 于 机 器 人 导航 的 激光 传感器 是 SICK 
LMS 200。 这 种 传感器 在 水 平方 向 以 180? [Bl JC ETT TH 
fii, Æ 0.05s 内 得 到 一 个 平面 上 720 个 距离 测量 点 。 
尽管 只 是 测量 到 一 个 平面 ， 信 息 好 像 比较 有 限 ， 但 是 


环境 模型 进行 同 高 度 匹 配 。 这 就 允许 对 该 环境 中 传 感 
器 的 位 置 (也 就 是 携带 该 传感器 的 机 器 人 的 位 置 ) 
进行 估算 。 当 然 ， 这 种 技术 要 求 被 扫描 的 环境 只 能 在 
固定 的 扫描 高 度 上 进行 扫描 。 另 一 种 常用 的 设置 是 将 
传感器 安装 在 机 器 人 的 较 高 处 并 向 下 倾斜 一 点 进行 扫 
描 。 在 这 种 设置 中 ， 随 着 机 器 人 的 前 进 ， 它 前 面 的 地 
面 被 依次 扫描 从 而 可 以 发 现 潜 在 的 障碍 物 。 
Mionlta910 是 一 种 三 角 测 量 传感器 ， 其 测 距 能 
达到 2m， 而 精确 度 大 约 是 0.01mm， 在 2.5s 内 能 
到 大 约 250000 个 点 。 这 种 传感器 广泛 地 应 用 于 小 块 
区 域 扫描 ， 例 如 检测 或 零件 建 模 ， 但 也 可 安装 在 一 个 
国定 点 用 于 扫描 机 器 人 的 工作 间 。 对 这 种 工作 间 的 观 
测 可 以 使 得 一 系列 动作 得 以 完成 ， 比 如 零件 检测 du 
落 物 的 定位 或 者 小 件 物体 传送 ， 或 者 零件 的 精确 定位 。 
用 于 机 器 人 导航 的 距离 传感器 的 更 多 案例 和 细节 


将 于 第 22. 3 小 节 介绍 。 


4 过 


22.2 距离 配 准 


这 一 节 将 介绍 的 技术 包括 机 器 人 操作 部 件 的 三 
维 定位 、 机 器 人 车 辆 的 自 定位 和 机 器 人 导航 中 的 景 
象 理 解 。 所 有 这 些 技术 都 建立 在 能 对 三 维 形状 进行 
配 准 的 基础 上 。 例 如 距离 图 像 对 距离 图 像 、 三 角 测 
量 面 或 几何 学 模型 的 配 准 。 在 22. 2.7 小 节 里 面 介 绍 
这 些 应 用 之 前 ， 我 们 先 看 看 使 用 三 维 数据 的 基本 
技术 。 
22. 2.1 


三 维特 征 的 表现 形式 


有 多 种 三 维 景象 结构 的 编码 和 建 模 的 表现 形式 ， 
但 接 下 来 要 介绍 的 是 机 器 人 应 用 里 最 常用 的 。 一 些 景 
象 的 模型 或 描述 可 能 同时 用 到 超过 一 种 表现 方式 ， 以 
从 景象 或 物体 的 不 同 侧面 进行 描绘 。 

1. 三 维 点 阵 

这 是 使 用 一 系列 三 维 点 tp, = (X, Yi, Z) 来 
描述 景象 中 的 一 些 显著 的 和 可 辨认 的 点 。 这 些 点 可 能 
是 球形 中 心 点 (通常 用 作为 标记 ) 、 三 个 平面 交叉 的 
角落 或 者 是 表面 凹凸 的 极 值 点 。 它 们 可 能 是 最 初 获得 
的 三 维 全 幅 景 象 点 阵 的 子 阵 ， 可 能 是 从 一 幅 距离 图 像 
截取 而 来 ， 也 可 能 是 基于 一 些 提取 的 数据 特征 计算 出 
来 的 理论 点 。 

2. 平面 

平面 是 从 一 个 景象 中 观测 到 的 一 系列 平坦 的 面 ， 
或 是 一 个 物体 模型 的 部 分 或 全 部 边界 范围 。 有 几 种 方 
式 表示 平面 ， 但 常用 的 是 使 用 平面 方程 ax + by + ez + 
d=0 来 表示 穿 过 对 应 景象 或 模型 表面 的 点 阵 1P; = 
(X,，Y,，2,)1。 一 个 平面 的 表示 只 需要 三 个 系数 ， 
因而 平面 的 表示 方法 (a, b, c, d) 常 有 一 些 额 外 的 
限制 , Pd =1 RE d +P +e =1。 向 量 n = (a, 
b,c)'/ Va +b +c 是 表面 的 法 线 向 量 。 

使 用 这 个 公式 只 能 将 平坦 表面 描绘 为 无 限 的 平 
面 , 但 是 还 需要 包括 对 表面 边界 的 表述 。 男 外 ， 有 关 
由 线 也 有 很 多 可 能 的 表示 方式 。 这 些 曲线 或 三 维 或 二 
维 的 存在 于 表 平 面 上 。 有 利于 机 需 人 应 用 的 表示 方式 
是 列 出 形成 边界 区 域 或 多 线条 的 三 维 点 (X, Y,, 
2Z,) | 。 多 线条 是 采用 一 系列 连接 在 一 起 的 线段 来 表 
示 边 界 。 一 个 多 线条 可 以 使 用 形成 项 点 并 连接 线段 的 
三 维 点 序列 | (X, Y, ZD) 来 表示 。 

3. 三 角 网 格 面 

这 种 表示 方式 使 用 一 系列 的 三 角形 小 块 描述 一 个 
物体 或 者 景象 。 其 他 更 多 的 一 般 性 的 多 边 形 表面 或 其 
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至 各 种 各 样 的 平滑 面 的 表示 方式 也 被 用 到 ， 但 是 三 角 
形 还 是 用 得 最 多 的 。 因 为 它们 简单 易 用 ， 而 且 在 低廉 
的 电脑 显卡 上 三 角形 也 能 高 速 显 示 出 来 。 

三 角形 可 以 很 大 (例如 当 用 以 表示 平坦 的 面 时 ) 
或 者 很 小 〈 比如 表示 曲面 时 ) 。 三 角形 尺寸 的 选择 反 
映 了 想 要 表示 的 物体 或 者 景象 面 需 要 的 准确 性 。 三 角 
网 格 面 就 被 观测 的 景象 或 者 物体 的 表面 为 三 角形 表示 
来 说 可 能 是 完整 的 ， 但 也 有 不 连贯 面 的 小 块 存在 的 情 
况 ， 这 些小 块 有 些 伴 随 着 内 部 小 洞 ， 有 些 则 没有 。 对 
机 器 人 的 抓 取 或 者 导航 来 说 ， 你 不 希望 在 景象 面 被 表 
示 的 部 分 之 前 存在 没有 被 表示 的 部 分 ， 而 机 器 人 的 抓 
取 器 或 者 机 器 人 本 身 可 能 会 撞 到 这 部 分 面 。 因 此 我 们 
假设 ， 如 果 把 边缘 完全 连接 起 来 ， 那 么 三 角 测量 算法 
生成 的 小 块 集会 将 所 有 实际 的 景象 面包 围 起 来 。 图 
22.11 显示 了 一 个 例子 ,三 角 网 格 面 覆 盖 在 原始 的 平 
滑 面 上 。 
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图 22.11 三 角 网 格 面 (感谢 T Breakon ) 


有 很 多 具有 些许 差别 的 不 同方 法 可 以 表现 三 角 
形 “” ,但 主要 的 方法 是 使 用 一 个 利用 i 个 三 角形 的 
角 顶 点 进行 索引 的 清单 fy, = (X, Y, Z), Mi 


从 三 角 网 格 面 的 小 块 ， 我 们 能 计算 出 潜在 的 
抓 取 物 的 位 置 、 洪 在 的 导航 表面 或 障碍 物 的 位 置 ， 
或 者 将 被 观测 的 表面 形状 与 之 前 存储 的 形状 进行 
匹配 。 

4. 三 维 线段 

平坦 的 表面 交汇 于 


三 维 线段 ， 它 是 很 容易 被 立体 


传感器 和 距离 传感器 检测 到 的 特征 。 这 些 特征 在 人 造 
境 中 (比如 墙 、 地板、 天 花 板 、 门 口 、 与 墙 结构 
形成 边缘 的 周边 比如 布告 牌 、 办 公 室 的 边界 和 仓库 的 
家 具 等 等 )。 它 们 在 人 造物 体 上 面 也 普遍 存在 。 以 立 
体 成 像 来 说 ， 表 面 形 状 或 颜色 的 改变 被 当做 边缘 ， 可 
以 在 立体 成 像 过 程 中 用 于 匹配 以 直接 产生 三 维 边缘 。 
对 距离 传 感 需 来 说 ， 平 坦 表面 可 以 很 容易 的 从 距离 数 
据 中 获得 ( 见 下 一 节 ) 而 且 邻 近 的 平面 可 以 相交 成 
为 边缘 。 

三 维 线段 最 直接 的 表示 方式 是 点 阵 x =p + Av, 
对 任何 和 ,vv 是 单位 向 量 。 这 种 表示 方式 有 五 个 自由 
度 ; 而 更 多 的 表示 方式 ， 比 如 具有 四 个 自由 度 的 表示 
方式 见 参考 文献 [22.2]. 

5. 三 维 像素 

三 维 像素 (大 量 像素 ) 方法 使 用 三 维 盒子 /单元 
表示 三 维 环境 ， 其 表明 的 是 环境 中 存在 的 景象 结构 和 
自由 空间 。 最 简单 的 表示 方式 是 三 维 二 进 制 序列 ， 使 
用 1 对 结构 进行 编码 而 0 表示 自由 空间 。 这 种 方式 可 
能 会 需要 大 量 内 存 ， 同 时 需要 很 多 的 计算 来 对 内 容 进 
行 像素 编码 。 更 复杂 但 更 简洁 的 表示 方法 是 称 为 八 又 
树 !* 下 层次 表示 方法 。 这 种 方法 是 把 整个 (包围 着 
的 ) 四 边 形 空间 分 割 成 八 个 小 四 边 形 子 空间 ， 称 为 
卦 限 (图 22. 12)。 一 个 树 状 数据 结构 把 每 一 个 卦 限 
的 内 容 编码 成 空 、 实 或 者 混合 。 混 合 的 部 分 再 被 划分 
为 更 小 的 八 个 四 边 形 卦 限 ， 编 码 成 大 树 的 子 树 。 这 种 
再 区 分 一 直 持 续 下 去 直到 得 到 最 小 的 卦 限 尺 寸 。 决 定 
个 三 维 像素 是 否 是 空 、 实 或 者 混合 是 根据 传感器 的 
数据 ， 但 是 ， 如 果 在 一 个 三 维 像素 里 面 没 有 三 维 数据 
点 存在 的 话 ， 那 它 的 内 容 很 可 能 就 是 空 。 同 样 Ani 
个 三 维 像素 里 面 有 很 多 三 维 数据 点 存在 的 话 ， 那 它 
的 内 容 很 可 能 就 是 实 。 剩 余 的 就 可 以 认为 是 混合 。 有 
关 三 维 像素 化 的 更 多 细节 可 以 在 参考 文献 [22. 31] 
中 找到 。 
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图 22. 12 递归 式 的 空间 分 解 以 及 对 应 八 叉 树 的 一 部 分 
为 了 进行 机 器 人 导航 、 定 位 和 抓 取 ， 只 有 表面 和 


自由 区 域 的 三 维 像素 需要 准确 标识 。 物 体内 部 和 景象 
结构 的 内 部 基本 上 不 相关 。 
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22.2.2 三 维特 征 的 提取 


2. 直线 
尽管 直线 在 人 造 环境 中 的 应 用 很 普遍 ， 而 直接 从 
三 维 数据 库 中 提取 直线 却 并 不 容易 。 难 度 的 主要 来 源 


趣 的 : 直线、 
数据 集 里 面 

1. 平面 

平面 通常 从 一 些 基于 种 子 小 块 的 区 域 增长 过 程 中 
找到 。 当 景象 大 部 分 由 平面 构成 时 ， 一 个 特别 简单 的 
办 法 是 基于 选择 以 前 没有 用 到 的 点 和 它 临近 区 域 的 点 
E fv; = (X;，Y;，2Z;)1。 使 用 最 小 二 乘法 可 以 将 这 
些 点 归纳 到 一 个 平面 : 使 用 点 阵 中 的 N 个 点 创造 出 
一 个 4 xN 的 矩阵 D， 每 一 个 点 增 大 1。 将 这 些 扩展 
的 点 称 为 |。 因为 每 一 个 点 都 位 于 同一 个 平面 
ax +by+cz+d=0 上 ,我 们 可 以 轻易 使 用 如 下 方法 来 
舍 算 平面 的 系数 向 量 p = (a, b, c, d)", RANÉ 
一 个 完美 的 平面 会 与 完美 的 数据 点 相 吻 合 ， 这 个 平面 
满足 条 件 Dp =0。 因 为 噪声 的 存在 ， 我 们 使 用 误差 向 
量 e =ZPDp 来 蔡 代 并 找到 可 以 使 它 的 长 度 〈 平 方 化 的 ) 
e*ezp D'Dp 最 小 化 的 向 量 p。 此 向 量 是 矩阵 D'D 
的 最 小 特征 值 的 对 应 特征 向 量 。 最 开始 假定 的 平面 需 
要 进行 合理 性 测试 : 中 检查 最 小 的 特征 值 ， 它 应 该 很 
小 而 且 与 期 待 的 噪声 水 平 的 平方 在 一 个 数量 级 ;人 @) 确 
保 大 多 数 三 维 点 位 于 平面 上 适当 的 阵列 里 〈 即 
Iv, * pl «0. 

大 型 的 平面 区 域 通过 确定 位 于 该 平面 上 的 临近 点 
六 (满足 | 六 - pl «T) 来 增长 。 当 足够 多 的 点 被 发 现 
以 后 ,平面 的 系数 p 重新 被 估算 。 被 测 得 的 平面 上 的 
点 被 移 除 ， 整 个 过 程 以 一 个 新 的 种 子 小 块 重复 。 这 个 
过 程 一 直 进 行 ， 直 到 没有 更 多 点 被 添加 进来 。 有 关 平 
面 特征 的 更 完整 描述 可 以 见 参 考 文献 [22. 32]。 

当 在 景象 中 发 现 的 平面 分 布 较为 稀 琉 时 ， 另 一 种 
称 为 随机 采样 一 致 性 (RANSAC) 的 特征 提取 算 
法 全 更 为 适用 。 当 使 用 这 种 算法 进行 平面 探测 时 ， 
这 种 算法 随机 选择 三 个 三 维 点 (尽管 对 点 选择 的 算 
法 使 用 一 些 定位 运算 可 以 提高 算法 的 效率 )。 这 三 个 
点 决定 了 一 个 系数 向 量 为 p 的 平面 。 对 所 有 点 阵 里 的 
点 pv) 进行 测试 看 它 是 否 属于 这 个 平面 (dH 
|y;*p|1<7T)。 如 果 有 足够 多 的 点 靠近 平面 ,那么 很 
可 能 一 个 平面 就 已 经 找到 了 。 这 些 点 也 会 进一步 被 处 
理 以 找 出 一 个 连接 起 来 的 点 阵 ， 通 过 这 个 点 阵 、 使 用 
上 述 的 最 小 二 乘法 可 以 估算 出 一 个 更 为 准确 的 平面 系 
数 。 如 果 平 面 小 块 已 被 找到 ， 在 这 个 小 块 上 的 点 将 从 
数据 库 移 除 。 随 机 从 数据 库 选 择 三 个 点 的 过 程 将 继 
续 ， 直 到 不 能 再 找 出 新 的 平面 (进行 这 种 尝试 的 次 
数 界限 是 可 以 预 估 的 ) 。 


平面 和 三 角 网 格 面 。 这 里 对 如 何 从 距离 
取 这 些 特征 进行 了 总 结 。 


在 于 三 维 传感器 常常 不 能 在 面 的 边缘 获取 很 好 的 数 
据 ， 这 是 因为 : 中 发 射 光 束 将 从 两 个 不 同 的 面 返 回 ; 
@) 激 光 传 感 器 会 在 这 种 条 件 下 产生 一 些 不 可 预期 的 效 
应 。 基 于 这 个 原因 ， 大 部 分 三 维 线段 提取 算法 是 间接 
的 ， 而 通过 先 检测 出 平面 (比如 使 用 上 一 段 介绍 的 
方法 ) ， 然 后 相 邻 的 平面 相交 。 相 邻 性 可 以 通过 找到 
相连 接 的 像素 从 一 个 平面 到 另 一 个 平面 形成 的 轨迹 ， 
被 检验 出 来 。 如 果 平 面 1 和 2 PIRA p, FI p, 
并 在 p, 和 p, 处 的 法 线 分 别 是 nn, 和 n,， 那 么 形成 的 相 
交 直 线 的 方程 是 x =a + Ad,， 式 中 , a 是 线 上 的 一 个 
A, Wid-n,xn,/]|n, xn, | 是 直线 的 方向 。 点 a 的 
可 能 性 会 有 无 穷 多 个 ， 这 可 以 通过 解 方程 组 a'n, = 
pin, 和 n, =p27w 确 定 。 可 以 通过 第 三 个 合理 的 限 币 
来 得 到 一 个 p, 旁 边 的 点 ， 这 个 限制 是 ard = pid, XX 
就 给 了 我 们 一 个 无 限 长 的 直线 ， 而 大 部 分 实际 应 用 需 
要 的 是 一 个 有 限 长 的 线段 。 线 段 的 端点 可 以 通过 以 下 
方法 估算 出 来 : 中 找到 两 个 平面 上 接近 观测 点 的 直线 
上 的 点 ; @ 找 到 这 些 点 的 两 个 极 值 点 。 男 一 方面 ， 使 
用 立体 传感器 可 以 使 得 找寻 三 维 线段 变 得 容易 一 些 ， 
因为 可 以 通过 匹配 两 个 二 维 的 图 像 线段 获得 。 

3. 三 角 网 格 面 

这 种 处 理 方法 的 目的 是 从 三 维 点 阵 中 估算 一 个 三 
角形 网 格 。 如 果 这 些 点 是 从 一 个 规则 的 网 格 取样 而 来 
(比如 从 一 个 二 又 二 分 之 一 维 的 距离 图 像 ) ， 那 么 三 
角形 可 以 从 采样 点 自然 而 然 地 形成 ( 见 图 22.13) 。 
如 果 这 些 点 是 三 维 点 阵 的 一 部 分 ， 那 么 三 角 面 的 形成 
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图 22. 13 一 个 规则 点 网 格 的 三 角 测量 
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大 多 , 但 是 有 一 些 要 考虑 的 问题 是 : 中 如 何 找到 距离 
所 有 点 都 很 近 的 平面 (因为 噪声 的 存在 ， 使 得 所 有 
点 都 落 在 同一 个 平面 上 是 不 可 能 的 ); @ 如 何在 网 格 
上 避免 洞 和 较 远 的 三 角形 ;如何 选择 距离 的 阔 值 以 
使 仅 有 一 个 平面 通过 点 阵 ; 加 如 何 选 择 三 角形 的 尺 
才 ; @ 怎 么 处 理 无 关 的 点 ; (@ 如 何 保留 可 观测 的 景 

特征 ， 比 如 平面 的 边缘 。 早 期 流行 的 三 角 测 量 算法 有 
移动 立方 体 算法 和 三 角形 算法 。 这 些 算法 可 
以 产生 具有 很 多 三 角形 的 网 格 。 通 过 网 格 优化 可 以 减 
少 三 角形 尺寸 从 而 降低 使 用 网 格 计算 的 复杂 程度 ， 有 
AR A DEAE TES RT LUKE HI PUT, 


22.2.3 模式 匹配 和 多 角度 配 准 


模式 匹配 是 将 一 些 存储 图 像 与 一 些 观测 数据 进行 


同样 可 以 进行 简单 的 累加 。 三 角 网 格 面 需要 更 复杂 的 
合并 ， 并 会 导致 一 个 我 们 需要 的 布局 正确 的 三 角 网 格 
结果 。 拉 链 算 法 '* 人 就 是 一 个 著名 的 三 角 网 格 合 并 
算法 。 

翻译 树 算法 下 ( 见 表 22.2) 适用 于 小 规模 
(例如 ,小 于 20 ~30) 不 连续 物体 的 匹配 ， 例 如 二 维 
或 三 维 图 像 中 的 垂直 边缘 。 如 果 有 MARNA D A 
物体 数据 ， 那 么 潜在 的 匹配 可 能 性 有 132 种 。 进 行 有 
效 匹配 的 关键 在 于 辨认 成 对 的 模型 、 数 据 具 有 的 限制 
以 排除 不 适合 的 配对 。 成 对 的 模型 特征 和 数据 特征 之 
间 的 限制 也 大 大 缩小 了 匹配 空间 。 如 果 这 种 限制 排除 
了 足够 多 的 特征 ， 一 个 时 间 多 项 式 算 法 就 产生 了 。 此 
算法 的 核心 如 下 。 假设 [m] 和 idi 分 别 是 需要 
进行 匹配 的 模型 和 数据 特征 ， 如 果 m, 和 dj 是 一 致 的 


匹配 的 过 程 。 在 这 里 讨论 的 情况 下 ， 我 们 假设 两 者 都 
是 三 维 的 。 更 进一步 ， 我 们 假设 进行 匹配 的 数据 都 是 
同一 类 型 的 ， 例 如 景象 线段 和 线段 的 三 维 模型 UR 
管 不 同 种 类 的 数据 也 可 以 进行 匹配 ， 我 们 不 考虑 这 些 
特别 的 算法 ) o 

匹配 的 一 个 特殊 情况 是 当 被 匹配 的 两 种 结构 都 是 
景象 或 者 模型 表面 的 时 候 。 这 种 情况 一 般 出 现在 试图 
将 一 个 景象 不 同 角度 的 图 像 融 合 ， 以 产生 此 景象 的 一 
个 更 大 的 图 像 。 这 些 不 同 角度 的 图 像 可 以 来 自 一 个 移 
动机 器 人 围绕 该 景象 的 多 个 地 点 进行 拍摄 得 到 的 。 移 
动机 器 人 学 里 的 同时 定位 与 地 图 创建 (SLAM) 算 
法 (将 于 第 37 章 进行 讨论 ) 就 是 在 逐渐 将 最 新 
观测 到 的 景象 部 分 融合 进 不 断 增 长 的 地 图 模型 的 同 
时 ,将 最 新 观测 到 的 数据 与 之 前 观测 到 的 数据 进行 匹 
配 以 估算 机 器 人 本 身 的 当前 位 置 。 有 一 个 SLAM 项 
目 '” 就 使 用 了 比例 不 变 特 征 转换 (SIFT) 的 特征 
点 进行 三 维 建 模 和 地 图 构建 。 

匹配 算法 的 使 用 取决 于 被 匹配 结构 的 复杂 性 。 如 
果 被 匹配 的 结构 是 延长 的 几何 元 素 ， 例 如 平面 和 三 维 
线段 ， 那 么 像 分 析 树 算法 ”之 类 的 离散 匹配 算法 
就 可 以 应 用 了 。 换 言 之 ， 如 果 结 构 简 单 ， 比 如 三 维 点 
或 三 角形 ， 那 么 使 用 像 是 迭代 最 近 点 算法 (ICP) 
之 类 的 点 阵 对 准 算法 就 行 了 。 两 种 情况 在 下 面 都 将 进 
行 详细 介绍 。 

在 结构 被 匹配 之 后 ， 最 常用 的 下 一 个 步 又 是 估算 
连接 两 个 数据 库 的 变换 〈 旋 转 加 上 位 移 ) 。 这 个 过 程 
在 下 一 节 进 行 介绍 。 通 过 变换 ， 我 们 就 可 以 将 数据 转 
换 进 同一 个 坐标 系 并 进行 数据 融合 (合并) 。 如 果 被 
融合 的 结构 是 点 ， 那 么 结果 就 是 一 个 由 两 个 (或 更 
多 ) 原始 数据 库 合 并 得 到 的 大 点 阵 。 平面 和 线段 阵 
列 经 历 一 次 表示 为 两 个 数据 库 的 匹配 的 组 成 部 分 后 ， 


THE, VW u(m,, dj) 为 真 ; 如 果 m, m, d, fll d È 
一 致 的 四 个 特征 ， 则 b(m;, m;, d,, dı) 为 真 ; 而 了 
是 在 一 次 成 功 匹 配 前 匹配 了 的 特征 的 最 小 数目 。 对 是 
成 功 匹 配 了 的 特征 集 。 方 程 truesizeof 对 特征 集 一 一 
对 中 的 实际 匹配 数目 计数 ， 并 忽略 使 用 可 以 对 任何 寻 
配对 的 通配符 “* ”参与 的 匹配 。 

当 进行 匹配 的 数据 是 点 阵 或 者 三 角形 的 时 候 ， 
ICP 算法 .更 为 常用 。 这 个 算法 估算 了 机 器 人 的 姿 
态 变 换 ， 此 变换 将 两 个 数据 集 进行 排列 以 使 其 间 的 距 
离 最 小 。 使 用 了 这 种 变换 ， 这 两 个 数据 集 可 以 在 同一 
个 坐标 系 中 表示 并 可 以 被 当做 一 个 大 的 单个 数据 集 
(可 能 会 合并 一 些 释 加 的 数据 ) 。 


表 22.2 翻译 树 算 法 


T8 


pairs = it(0, 1] ) 


if truesizeof( pairs) > =T, then success 


function pairs = it( level , inpairs ) 
if M- level + truesizeof( inpairs) < T 
then return |} % 永远 不 能 匹配 成 功 
for each d_i % D 循环 开始 
if not u(m_level ,d_i) ,then continue loop D 
for each( m. k,d 1)in inpairs 
if not b(m level, m k,d i,d 1l) 
then continue loop D 
endfor % 已 经 成 功 找到 一 个 新 的 配对 


pairs = it( level + 1 ,union( inpairs, (m_level ,d_i) ) ) 


if truesizeof( pairs) > =T,then return pairs 
endfor% D 循环 结束 
% 匹配 不 成 功 ,尝试 通配符 


pairs = it( level +1,union( inpairs, ( m. level, * ) ) ) 
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在 这 里 我 们 给 出 点 匹配 算法 ， 它 也 很 容易 的 适用 
于 其 他 类 型 的 特征 。 这 种 算法 是 迭代 的 ， 因 而 不 一 定 
总 能 很 快 收敛 , 但 常常 数 个 循环 就 是 以 (成 功 收 
DO. BÆ, ICP 算法 可 能 会 导致 数据 集 的 错误 匹配 。 
最 优 结 果 来 自 于 一 个 好 的 初始 预测 ， 比 如 来 自 里 程 仪 
或 以 前 的 机 器 人 位 置 。ICP 算法 可 以 被 延伸 以 包括 其 
他 性 质 进行 匹配 ， 比 如 颜色 和 局 部 邻近 结构 。 一 个 好 
的 空间 编号 算法 (比如 k-d 树 ) 是 以 下 在 最 近 点 方 
FE (CP) 中 进行 有 效 配对 所 必需 的 。 

假设 8 是 一 个 具有 AN 个 点 ds, on, sud 而 .家 
是 待 匹配 的 模型 。 假 设 ||s -m 上 是 两 个 点 se8 和 me 
.友之 间 的 几何 距离 。 假设 CP(s, A) 是 在 .中 中 
离 (几何 距离 ) 景象 点 s 最 近 的 点 。 

1) [E TO 是 将 两 个 数据 集 进行 对 准 的 刚性 转 
速 的 初始 预测 。 

2) 对 =1，…，, 进 行 循环 或 直到 收敛 .: 

D 计算 对 应 集 C = UN, i(s, CP (T^ 
(s), Æ) ) lo 

@ 计算 新 的 、 使 C 中 点 对 的 均 方 误差 最 小 的 几 
何 变 换 M 


22.2.4 RAURA E 


一 种 距离 扫描 数据 匹配 的 常用 技术 ， 特 别 是 在 二 
维 情况 下 ， 是 使 用 最 大 似 然 作为 匹配 好 坏 的 标准 。 这 
种 技术 同时 也 考虑 了 距离 读数 的 一 个 概率 模型 。 假 设 
r+ 是 在 位 置 s 处 的 一 个 传感器 扫描 的 距离 读数 ， 而 7 
是 在 沿 + (取决 于 s) 的 路 径 上 最 近 的 物体 的 距离 。 
那么 一 个 传感器 读数 的 模型 则 是 概率 P (r1 7) 。 通 常 
这 个 模型 具有 一 个 围绕 正确 距离 的 高 斯 形状 ， 并 拥有 
一 个 较 早 的 误 判 区 域 和 一 个 漏 读 的 尾 端 区 域 ( 见 图 
22. 14) 。 


当 一 个 扫描 的 位 置 ， 基 于 一 个 参考 扫描 ， 对 所 有 
的 读数 产生 一 个 最 大 似 然 佑 计时， 匹配 就 产生 了 。 假 
设 读数 之 间 是 独立 的 ， 由 Bayes 规则 我 们 得 到 

max p(s |r) = max] | DCT; | F) 

最 大 似 然 扫描 的 位 置 可 以 通过 登山 法 或 者 从 一 个 好 的 
开始 位 置 进行 穷 举 搜寻 法 找到 。 图 22. 15 显示 了 使 用 
最 大 似 然 对 一 个 扫描 针对 几 个 参考 扫描 进行 对 准 的 结 
果 。 在 这 个 二 维 的 例子 里 ， 参 考 扫描 放置 于 一 个 占据 
网 格 里 进行 计算 4) 。 一 个 为 了 提高 效率 而 广 为 流 
传 的 修改 是 对 这 个 占据 网 格 进行 拖 尾 操作 ， 忽 视 视 线 
信息 ， 从 而 计算 出 22 。 在 三 维 情况 下 ， 三 角 网 格 
面 比 三 维 像素 法 更 为 适用 '**|。 


概率 
0.125 

一 一 一通 近 函 数 
100p 7770780 ass 测量 结 


0.075 


400 $00 
测量 距离 /cm 
图 22. 14 一 个 激光 传感器 读数 的 概率 轮廓 p(r | 7) 

(高 斯 的 顶峰 出 现在 距离 被 扫描 的 物体 7 处 O81) 


100 200 300 


Æ 22.15 在 一 个 占据 网 格 里 对 一 个 扫描 
针对 几 个 参考 扫描 进行 匹配 21 


22.2.5 多重 扫描 配 准 


在 之 前 的 小 节 里 ， 多 个 参考 扫描 可 以 用 以 形成 一 
个 占据 网 格 或 表面 三 角形 ， 以 进行 匹配 。 通 常 来 说 ， 
在 几 个 扫描 之 中 形成 的 扫描 配对 可 以 在 这 些 扫 描 中 产 
生 一 个 限制 集 。 例 如 ， 在 机 器 人 完成 一 个 路 径 的 环线 
时 ， 连 续 的 扫描 形成 一 个 链条 形 的 限制 ， 而 第 一 个 和 
最 后 一 个 扫描 形成 了 一 个 限制 的 闭环 。 全 局 性 的 对 扫 
描 进 行 一 致 的 配 准 是 SLAM 的 一 部 分 ( 见 第 37 章 ) 。 
如 果 单 个 的 限制 具有 协 方差 的 估算 ， 那 么 最 大 似 
然 法 可 以 用 以 为 所 有 的 扫描 找到 一 个 全 局 性 的 一 致 的 
AGE 47) 。 这 个 全 局 性 对 准 是 对 扫描 姿态 进行 的 ， 
而 不 涉及 扫描 本 身 ， 也 就 是 说 ， 所 有 的 信息 简化 为 对 
姿态 的 限制 。 假 设 5, 是 介 于 扫描 s, 和 ;之 间 的 配对 的 
BASH, 具有 协 方差 T;。 那 么 对 所 有 s 来 说 最 大 似 然 
估计 由 下 面 这 个 非 线性 最 小 二 乘 系统 给 出 
min >， (s; -号 ) "Ty (sy - 55) 
此 系统 可 以 使 用 循环 最 小 二 乘法 有 效 地 求解 ， 比 如 
Levenberg- Marquadt 3X zi H4 HEE BY ， 
一 个 复杂 的 因素 是 系统 的 限制 是 基于 一 组 起 始 的 
姿态 * 计算 出 来 的 。 利 用 式 (22.8) 对 * 进行 重新 计 
算 ， 基 本 上 ， 重 新 进行 扫描 匹配 将 产生 一 组 不 同 的 限 


(22.8) 


lim 
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制 。 重复 使 用 新 的 限制 进行 配 准 不 能 保证 导致 全 局 性 
的 收敛 。 事实 上 ,使 用 一 个 好 的 初始 估计 ， 快速、 
和 鲁 棒 的 收敛 是 常常 可 以 获得 的 。 


22.2.6 相对 姿态 预测 


对 很 多 任务 来 说 ， 核 心 问题 是 两 个 坐标 系 间 坐 标 
系 的 相对 位 置 或 者 姿态 转换 的 估算 。 比 如 ， 这 个 任务 
可 能 是 计算 一 个 安装 在 机 器 人 上 的 扫描 仪 相 对 于 景象 
显著 标志 的 姿态 ， 或 者 是 估算 在 两 个 不 同位 置 不 同 角 
度 观 测 到 的 一 些 景象 特征 的 相对 姿态 。 

我 们 在 这 里 介绍 三 种 涵盖 大 多 数 姿态 估算 处 理 的 
算法 。 算 法 随 需要 匹配 特征 种 类 的 不 同 而 略 有 差异 。 

1. 点 阵 相 对 姿态 估算 法 
第 一 个 算法 对 点 阵 进 行 匹 配 。 假 设 在 一 个 结构 或 
坐标 系 里 有 NN 个 三 维 点 (m) 与 另 一 个 不 同 坐 标 系 
的 点 阵 (d) 进行 匹配 。 匹 配 可 能 是 刚刚 讨论 过 的 
ICP 算法 里 面 对 准 过 程 的 一 部 分 ;也 可 能 ， 比 如 ， 是 
与 之 前 构造 的 三 角 成 型 景象 模型 进行 匹配 的 观测 到 的 
三 角形 项 点。 期 望 的 姿态 是 旋转 矩阵 R 和 使 之 ， 
| Rm; « t- d, |f BDAY E ep te to 计算 这 两 个 点 阵 
的 均值 向 量 p, Ale, EH a =m, -p, fll b, =d; -p, 
计算 中 心 化 点 阵 。 通 过 向 量 }a;} 相 加 构建 3 x NB 
阵 4。 用 类 似 的 办 法 从 向 量 fb, | 构建 3 x NABIE B. 
计算 奇异 值 分 解 svd( BA") = U'DV' 7*9" 。 计 算 旋转 
ABER = VU ”。 如 果 点 阵 所 处 的 面 接近 平面 ， 那 么 计 
算 可 以 引入 镜面 图 像 变换 。 这 可 以 通过 向 量 三 倍 乘积 
进行 检查 ， 如 果 是 镜面 的 ， 那 么 对 角 线 纠正 矩阵 C 
(1, 1, -1) 可 以 用 于 R = VCU' 中 。 最 后 ， 计 算 位 
移 向 量 t =u; - Re,。 使 用 变换 的 最 小 二 乘 估算 ， 点 
m, ASA Rm, +t， 该 点 应 该 距离 d, 很 近 。 

2. 直线 相对 姿态 估算 法 

如 果 被 抽取 的 三 维特 征 是 直线 ， 那 么 相对 姿态 的 
转换 可 以 用 如 下 方法 计算 。 假 设 有 NN 对 直线 。 第 一 
个 直线 组 使 用 方向 向 量 de] 和 每 条 直线 上 一 点 
la) 表示 。 男 一 个 直线 组 使 用 方向 向 量 | fi 和 每 
条 直线 上 一 点 [b] 表示 。 在 这 个 算法 里 ,我 们 假设 
被 匹配 的 线段 的 方向 向 量 总 是 指向 同一 方向 〈 即 没 
有 颠倒 ) 。 这 可 以 通过 使 用 某 些 景象 限制 取得 ， 或 者 
通过 尝试 所 有 组 合 去 除 不 一 致 的 解决 方案 获得 。 点 a, 
和 5b; 在 对 准 后 不 需要 对 应 同一 个 点 。 期 望 的 旋转 矩阵 
R 使 ,|Re, -大 下 最小。 通过 向 量 [e| 相 加 构建 
3 xN 和 矩阵 E。 用 类 似 的 办 法 从 向 量 f| 构建 3xN 
矩阵。 计算 奇异 值 分 解 svd (FE) = UDV", 计算 
旋转 矩阵 R = VU 。 位 移 估算 t 使 旋转 点 a; 和 对 应 线 


(fj, bj) 之 间 的 距离 ,的 平方 和 最 小 。 定 义 一 个 矩 
阵 L = X,ü- ff) G- ffi). @X Mia = X, - 
Ff ü- ff) (Ra; -b) s WA et -Lo'n, 

3. 平面 相对 姿态 估算 法 

最 后 ， 如 果 被 抽取 的 三 维特 征 是 平面 ， 那 么 相 
对 姿态 的 转换 可 以 用 如 下 方法 计算 。 假 设 及 个 成 
对 平面 。 第 一 个 平面 组 使 用 平面 法 线 向 量 |e,| 和 
每 个 平面 上 一 点 Ja) 表示 。 另 一 个 平面 组 使 用 平 
面 法 线 向 量 Df 和 每 个 平面 上 一 点 [b] 表示 。 
这 里 我 们 假设 平面 法 线 总 是 从 平面 里 向 外 穿 过 。 点 
a; 和 5b, 在 对 准 后 不 需要 对 应 同一 个 点 。 期 望 的 旋转 
BP RED, |Re,- f. 必 最小。 通过 向 量 |e,| 相 加 
构建 3 x NN 矩阵。 用 类 似 的 办 法 由 向 量 |f) 构建 
3x N ABE F, 计算 奇异 值 分 解 svd ( FE’) = 
UV"DV'。 计算 旋转 矩阵 R = YU7。 位 移 估算 上 使 旋转 
点 ;和 对 应 平面 (f;，5b,) 之 间 的 距离 ,的 平方 和 最 
小 。 定 义 一 个 矩阵 已 = X, ffi, EMM btn = X, fi 
(Ra, -b;) 。 那 么 位 移 是 ! = - Lon. 

在 上 述 所 有 的 计算 中 ,我 们 假设 误差 都 是 正 态 分 
布 的 。 使 这 些 计算 更 加 鲁 棒 的 技术 参见 参考 文献 
[22.51]. 


22.2.7 三 维 应 用 


这 一 小 节 将 要 把 上 一 小 节 介 绍 的 技术 与 机 器 人 一 
些 应 用 连接 起 来 。 这 些 应 用 包括 为 了 机 器 人 操作 的 零 
件 的 三 维 定 位 、 机 器 人 自我 定位 和 帮助 机 器 人 导航 的 
景象 理解 。 这 些 将 要 提 及 的 机 器 人 任务 将 在 其 他 章节 
陆续 进行 详细 介绍 。 尽 管 这 一 章 关 注 的 是 机 器 人 应 
用 ， 三 维 传 感 应 用 还 存在 于 其 他 很 多 领域 。 一 个 最 近 
的 研究 领域 是 三 维 模型 的 获取 ， 特 别 是 为 了 机 械 零 件 
Bg] TRU 75 X770 mOSUEJOOU 、 电 脑 游 
戏 和 电影 里 面 的 人 物 角 色 (比如 ， 见 Cyberware 的 全 
身 X 三 维 扫描 仪 ) 。 

机 器 人 操作 的 关键 任务 是 : 中 抓 取 点 的 辨认 
(第 27 和 28 Æ); @ 无 碰撞 抓 取 辨认 (第 27 和 28 
章 ) ; @@ 操 作对 象 的 辨认 (第 23 章 ); 由 操作 对 象 的 
位 置 估算 (5823 和 42 章 ) 。 

机 器 人 导航 和 自我 定位 的 关键 任务 是 : @ 一 个 可 
导航 地 面 的 辨认 (3822.3 节 ) ; @ 无 碰撞 路 径 的 辩 
jk (第 35 章 ) ; @ 地 标 辨 认 (第 36 Æ); @ 机 器 人 
位 置 估算 (第 37 和 40 章 )。 

移动 机 器 人 和 生产 线 机 器 人 的 任务 其 实 很 自然 地 
联系 了 起 来 。 当 我 们 考虑 的 任务 是 处 在 一 个 未 知 的 零 
件 或 路 径 的 背景 的 时 候 ， 第 1 个 和 第 5 个 任务 就 有 了 
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个 共同 点 。 零 件 的 抓 取 需 要 找到 一 个 零件 可 以 被 抓 取 
的 区 域 ， 这 个 区 域 常 意味 着 局 部 平坦 的 小 块 。 这 些小 
块 保证 足够 的 尺寸 使 抓 取 器 可 以 与 它们 有 良好 的 接 
触 。 同 样 ， 导 航 通常 需要 平滑 的 地 面 区 域 ， 大 到 足以 
机 器 人 可 以 在 其 中 导航 ; 同样 ， 这 个 区 域 还 是 意味 着 
局 部 平坦 的 小 块 。 两 个 任务 都 是 基于 三 角 场 景 法 来 表 
示 数 据 ， 而 从 中 可 以 抽取 近乎 共 面 的 小 块 组 成 的 连贯 
区 域 。 两 个 任务 主要 的 不 同 点 在 于 地 面 平面 检测 任务 
是 寻找 一 大 块 区 域 ， 而 这 块 区 域 必须 在 地 面 上 而 且 面 
朝 上 方 。 

任务 2 和 6 都 需要 一 个 方法 来 表示 抓 取 吉 或 机 器 
人 沿 可 移动 路 径 的 空间 。 三 维 像素 法 很 适合 于 这 种 
任务 ， 

任务 3 和 7 都 是 模型 匹配 任务 ， 都 可 以 使 用 
22.2.3 小 节 介 绍 的 方法 ， 将 被 观测 到 的 景象 特有 
与 事先 存储 的 已 知 零件 或 者 景象 地 点 的 模型 进 
匹配 。 通 用 的 特征 是 大 的 平面 、 三 维 边缘 和 三 维 
特征 点 。 
任务 4 和 8 都 是 姿态 估算 ， 都 可 以 使 用 第 22.2.6 
小 节 介 绍 的 方法 ， 去 估算 物体 相对 于 传感器 或 机 器 人 
CELERA) 在 景象 中 的 姿态 。 通 用 的 特征 ， 同 样 
是 大 的 平面 、 三 维 边缘 和 三 维特 征 点 。 


22.3 导航 与 地 形 分 类 


距离 数据 较为 引 人 注 目的 用 法 是 移动 机 器 人 的 导 
航 。 距 离 数据 以 一 种 直观 的 几何 形式 ， 给 出 了 机 絮 人 
相关 的 障碍 物 和 自由 空间 的 信息 。 因 为 导航 的 实时 需 
要 ， 在 导航 中 使 用 本 章 介绍 的 技术 进行 地 形 的 三 维 模 
型 重建 往往 是 不 现实 的 。 取 而 代 之 的 是 ， 许 多 系统 使 
用 一 种 海拔 模型 。 海 拔 模型 是 一 种 将 空间 分 割 成 小 格 
形状 的 二 维 表现 方式 ， 每 一 个 小 格 里 面包 含 了 三 维 点 
在 此 小 格 内 的 分 布 信息 。 在 最 简单 的 实例 中 ， 海 拔 模 
型 地 图 仅仅 包含 了 距离 数据 高 于 所 谓 地 平面 的 高 度 均 
值 ( 见 图 22. 16) 。 这 种 形式 对 于 室内 和 城市 环境 来 
说 足够 了 ; 更 复杂 的 表现 方式 会 决定 一 个 局 部 平面 ， 
然后 决定 点 在 一 个 小 格 里 的 分 布 等 ,适用 于 在 更 复杂 
的 野外 环境 里 面 的 驾驶 。 标 记 了 障碍 物 位 置 的 海拔 地 
图 在 为 机 器 人 无 碰撞 路 径 规 划 方 面具 有 显而易见 的 
作用 。 


22.3.1 室内 环境 重建 


使 用 二 维 激 光 测 距 仪 的 SLAM 算法 (第 37 章 ) 
可 以 重建 厘米 级 精度 的 地 面 环境 。 一 些 研 究 将 这 种 算 


图 22.16 城市 地 形 的 海拔 模型 地 图 。 (每 一 个 小 格 
包含 了 在 该 点 的 地 形 的 高 度 。 更 密集 的 特征 也 可 以 
插入 在 这 种 地 图 里 面 ， 比 如 斜坡 、 点 方差 等 25] ) 


法 延伸 至 三 维 环境 的 重建 ， 随 机 器 人 的 移动 使 用 二 维 
激光 测 距 仪 对 环境 进行 扫描 字 引 ， 产 生 的 点 阵 通过 
机 器 人 的 姿态 ， 而 不 是 使 用 这 一 章 介 绍 过 的 对 准 技 
术 ， 进 行 配 准 。 这 是 因为 激光 测 距 仪 的 扫描 是 通过 机 
器 人 的 运动 完成 的 。 而 机 器 人 的 姿态 通过 二 维 SLAM 
算法 进行 纠正 。 

原始 点 可 以 用 三 维 图 像 表 示 出 来 、 或 将 室内 表面 
用 三 角 成 型 的 方法 以 平面 或 网 格 重 建 等 方法 表示 出 
来 。 当 照相 机 图 像 按 纹理 分 布 在 表面 上 时 ， 使 用 网 格 
重建 法 产生 的 效果 格外 引 人 人 注目， 可 以 创建 真实 感 很 
强烈 的 三 维 模型 。 图 22. 17 显示 了 使 用 这 种 技术 进行 
室内 重建 的 一 些 结果 。 对 一 些 表 面 的 小 块 的 平滑 处 理 
可 以 用 于 平坦 表面 的 恢复 :好 ?1 。 


图 22. 17 使 用 一 个 垂直 面 扫描 激光 雷达 产生 的 三 维 室 
内 地 图 重建 (点 阵 的 配 准 使 用 了 基于 一 个 水 平面 激光 雷 
达 的 SLAM 算法 25] ) 


22.3.2 ”城市 环境 导航 


在 城市 环境 导航 中 ,环境 ， 伴 随 着 环境 中 的 路 
面 、 建 筑 物 、 人 行道 以 及 一 些 移动 的 物体 一 一 人 和 其 
他 交通 工具 ， 被 重建 。 有 两 个 难点 : 如 何 对 来 自 快速 
移动 中 的 交通 工具 的 激光 扫描 数据 进行 配 准 以 进行 地 
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图 创建 ; 如 何 使 用 距离 扫描 数据 探测 移动 的 物体 
(当然 ， 其 他 用 以 探测 移动 物体 的 方法 也 是 存在 的 ， 
比如 基于 外 表 的 视觉 ) 。 

室外 交通 工具 可 以 使 用 精确 的 全 球 定 位 系统 
(GPS) 、 惯 性 导航 仪 和 车 轮 里 程 仪 来 追踪 自己 的 位 置 
和 方向 角 ， 通 常 使 用 的 技术 是 延伸 式 卡尔 曼 滤 波 器 。 
这 种 方法 足以 解决 在 扫描 图 像 之 间 进 行 精确 配 准 的 需 
要 ， 条 件 是 使 用 交通 工具 的 移动 模型 和 距离 扫描 仪 的 
计时 ， 将 每 一 个 扫描 数据 在 全 局 坐标 系 中 进行 准确 定 
位 。 这 种 方法 也 适用 于 相对 较 简单 的 野外 地 形 里 ， 比 
如 在 DARPA 的 机 器 人 大 奖 赛 里 ”3。 在 各 种 情况 
下 ， 机 器 人 姿态 估算 误差 的 减 小 是 造成 良好 性 能 的 关 
AR”, 
一 旦 扫描 数据 使 用 机 器 人 的 姿态 估计 进行 注册 ， 


图 22. 18 一 个 城市 景象 的 海拔 地 图 ， 使 用 的 单元 尺寸 是 
10cm xl0cm (障碍 物 用 红色 、 地 平面 用 绿色 表示 91) 


动物 体 '”“" 。 当 立体 成 像 仪 安装 在 移动 的 交通 工具 
上 时 ， 人 情况 比较 复杂 ， 因 为 整个 景象 相对 于 成 像 仪 都 


它们 就 可 以 放置 于 一 个 海拔 模型 地 图 里 。 海 拔 地 图 里 
每 一 个 小 格 里 保存 了 使 用 斜坡 和 距离 读数 的 垂直 分 量 
表示 的 检测 到 的 障碍 物 信 息 。 有 一 种 可 能 存在 的 复杂 
性 在 于 城市 环境 的 多 重 海拔 分 布 ， 例 如 ， 一 个 天 桥 如 
果 太 高 的 话 就 不 会 成 为 障碍 物 。 有 一 种 办 法 是 在 每 一 
个 小 格 里 使 用 多 重 海拔 数据 串 ， 这 种 技术 称 为 多 重 表 
面 地 图 (MLS， 见 参考 文献 [22. 55 ] ) 。 地 图 的 每 一 


是 移动 的 。 这 个 问题 可 以 通过 估 测 成 像 仪 相对 于 景象 
中 较 突出 的 固定 背景 的 移动 进行 解决 。 假 设 RR， 1 是 
成 像 仪 在 两 帧 图 像 间 的 运动 ， 使 用 第 37 章 里 将 要 介 
绍 的 技术 ,提取 特征 并 将 特征 在 两 个 帧 中 进行 匹配 ， 
可 以 估算 出 成 像 仪 的 运动 。 式 (22.6) EXT ÉY H 
(R, t) 将 第 一 帧 的 视差 向 量 po = (xo, yo, do, 1) 
EAZ R, 1 后 直接 投射 到 第 二 帧 里 的 对 应 向 量 


个 单元 保存 了 一 套 由 高 度 均 值 和 方差 表示 的 面 。 图 
22. 18 显示 了 标记 了 地 面 和 障碍 物 的 MLS， 单 元 尺寸 
是 100cm?。 

对 动态 物体 来 说 ， 工 作 频 率 为 15 ~ 30Hz 的 实时 
立体 成 像 技 术 可 以 抓拍 到 物体 的 运动 。 当 立体 成 像 仪 
固定 时 ， 对 距离 背景 图 像 进行 减法 操作 就 能 隔离 出 移 


H(R, 1) po。 使 用 单 应 性 可 以 将 参考 帧 里 的 点 不 通 
过 转化 为 三 维 点 ， 而 直接 投射 到 下 一 个 帧 里 。 图 
22. 19 显示 了 参考 景象 中 经 历 了 刚性 移动 的 投射 像 
素 。 投 射 像素 和 真实 像素 的 差别 给 出 了 独立 移动 的 物 
WRR, 


图 22. 19 一 个 移动 平台 的 独立 运动 探测 


a) 参考 图 像 b) 投射 图 像 


22.3.3 复杂 地 形 

复杂 的 室外 地 形 具有 两 个 难点 : 

1) 可 能 没有 密集 的 地 面 像素 而 不 能 分 辨 出 能 轰 
驶 的 路 面 和 障碍 物 。 


c) 投射 图 像 与 实际 图 像 的 差 


2) 柔软、 可 以 驶 过 的 植物 可 能 在 距离 图 像 中 看 
起 来 像 是 障碍 物 。 

图 22. 20 显示 了 一 个 典型 的 室外 景象 ， 其 中 一 个 
小 机 器 人 (1m). 驶 过 植被 和 复杂 的 地 形 汪 “  。 来 自 
机 器 人 上 的 立体 成 像 仪 的 距离 数据 可 以 看 到 植被 的 顶 


第 22 章 ”距离 传感器 77 


部 和 一 些 下 面 的 地 面 点 。 可 以 使 用 海拔 模型 去 检测 每 
一 个 单元 的 点 的 统计 特性 ， 以 捕捉 一 个 局 部 地 面 的 特 
征 并 发 现 对 植被 的 穿 透 性 。 以 参考 文献 [22.65] 为 
例 ， 给 出 了 一 些 特征 : 


图 22. 20 复杂 地 形 ， 没 有 地 平面 ， 
只 有 可 在 上 面 驾驶 的 植被 OO! 


1) 使 用 鲁 棒 匹 配 得 到 的 主要 斜面 (第 22.2.2 
小 节 ) 。 

2) 最 大 和 最 小 高 度 的 高 度 差 。 

3) 主要 平面 之 上 的 点 。 

4) 密度 : 单元 格 内 的 点 与 穿 过 单元 格 的 点 的 比率 。 

密度 是 一 个 很 有 趣 的 特征 (计算 量 也 很 大 ), € 
察看 距离 读数 是 否 穿 越 了 一 个 海拔 模型 的 单元 格 ， 以 
尝试 去 总 结 植被 ， 比 如 一 块 草地 或 灌木 从 的 特征 。 使 
距离 读数 去 估 测 植被 的 概念 在 几 个 有 关 野 外 驾驶 的 
HA PPE Tatil! 。 

海拔 地 图 的 单元 格 可 以 通过 学 习 或 者 手工 分 
类 法 区 分 障碍 物 或 者 可 驾驶 区 域 。 学 习 的 技术 包 
括 了 神经 网 络 '*“ “和 具有 最 大 期 望 学 习 法 的 高 共 
混合 模型 '* $1。 手工 分 类 法 则 包括 了 较 低级 的 诠 
释 、 将 表面 分 类 为 平坦 的 小 块 (地 面 ,固体 障碍 
物 ) 、 线 性 特征 (电话 线 ) 和 分 散 特 征 (植被 )。 
图 22. 21 显示 了 一 个 激光 扫描 的 室外 景象 的 结果 。 
诸如 电话 线 和 电线 杆 之 类 的 线性 特征 被 准确 的 标 
示 了 出 来 ， 而 具有 很 高 的 穿 透 性 的 植被 也 标示 了 
出 来 。 

复杂 地 形 的 导航 还 有 一 些 额外 的 问题 。 对 于 基本 
机 器 人 运动 的 平面 激光 测 距 仪 ， 在 其 扫描 地 形 时 ， 机 
器 人 的 姿态 预测 精度 对 于 准确 的 地 形 重 建 是 很 重要 
的 。 哪 怕 小 于 0. 5° 的 角度 误差 就 可 以 造成 障碍 物探 
测 的 误 报 ， 特 别 是 扫描 机 器 人 前 面 较 远 的 地 方 时 。 在 
参考 文献 [22. 60] 里 面 ， 这 个 问题 通过 察看 每 一 个 


图 22.21 使 用 点 统计 法 进行 的 分 类 297 (红色 是 平坦 的 
面 、 蓝 色 是 细 线 性 面 、 绿 色 是 分 散 的 、 可 穿 透 的 面 9) 


激光 读数 的 时 间 并 计算 高 度 误差 与 读数 时 间 差 的 相关 
系数 解决 。 

明 性 障碍 物 (地 沟 和 绝壁 ) 很 难 使 用 距离 信息 
检验 出 来 ， 这 是 因为 传感器 可 能 无 法 看 到 此 类 障碍 物 
的 底部 。 当 车 载 传 感 顺 距离 地 面 较 近 而 看 的 较 远 的 时 
候 ， 这 种 情况 尤其 明显 。 阴 性 障碍 物 可 以 通过 地 平面 
上 的 缺口 以 及 斜 向 缺口 后 面 边 缘 的 平面 推测 出 来 。 这 
些 特征 可 以 通过 视差 图 像 上 的 列 搜索 很 快 地 找 
出 来 23] 


22.4 结论 与 扩展 阅读 

机 器 人 学 里 距离 传 感 是 一 个 活跃 、 不 断 扩 展 的 领 
域 。 不 断 出 现 的 新 仪器 ， 如 快 闪 激光 雷达 、 多 光束 激 
光 雷 达 、 照 相机 自 带 立体 成 像 处 理 器 ， 以 及 持续 发 展 
的 可 靠 算 法 ， 如 物体 重建 、 定 位 和 地 图 创建 ， 使 得 机 
器 人 应 用 走出 了 实验 室 ， 走 进 了 真实 的 世界 。 使 用 激 
光 雷 达 的 室内 导航 已 经 用 于 商业 产品 ( 比如 参考 文 
献 [22. 69] ) 。 随 着 基础 能 力 变 得 更 加 可 靠 ， 研 究 员 
们 开始 关注 更 有 用 的 任务 ， 比 如 拿 物 品 或 做 
SN 70] : 

另 一 类 挑战 存在 于 恶劣 环境 中 ， 比 如 城市 和 野 
外 驾驶 (DARPA 机 器 人 大 奖 赛 和 城市 大 赛 叶 ?1 ) 。 
立体 成 像 和 激光 测 距 在 新 一 代 依 靠 走路 进行 移动 的 
HEAT AB LAR OE GO) ， 为 机 器 人 的 自动 性 提 
供 了 很 大 帮助 。 这 种 平台 的 运动 相对 于 轮 式 平台 来 
说 较为 粗糙 。 而 需要 处 理 包 含 了 动态 障碍 物 的 环境 ， 
以 及 以 任务 为 导向 的 物体 辨识 ， 也 增加 了 此 类 平台 
的 难度 。 
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三 维 视 党 及 识别 


Kostas Daniilidis, Jan- Ol of Eklundh 
朱琳 琳 赵 X 唐 延 东 译 


本 章 提出 的 方法 适用 于 装配 有 单 相机 或 多 相机 
的 机 器 人 。 我 们 的 目的 是 对 三 维 (3-D) 运动 及 空 
间 结 构 估 计 给 出 表述 和 模型 ， 并 给 出 识别 方法 。 我 
们 不 会 深入 地 讨论 估计 与 推理 问题 ， 这 些 会 在 其 他 
章节 进行 详细 的 说 明 。 同 样 ， 我 们 很 支持 与 其 他 传 
感 器 的 融合 ， 但 是 也 不 会 在 本 章 讨论 。 

在 第 一 部 分 中 ， 我 们 描述 了 从 二 维 (2-D) 图 
像 推理 到 三 维 世 界 的 主要 方法 。 在 这 点 上 ， 我 们 可 
以 提出 一 种 至 少 是 在 一 个 小 的 范围 内 的 解决 方式 。 
如 果 可 以 跟踪 图 像 中 的 一 些 特征 点 ， 我 们 就 可 以 
估计 机 器 人 自身 的 运动 和 与 任何 已 知 地 标的 相对 
位 置 关 系 。 解 决 这 种 最 小 化 问题 ， 最 直接 的 方法 
就 是 随机 抽样 。 如 果 没 有 已 知 的 3-D 地 标 ， 摄 像 
机 的 计算 轨迹 会 发 生 偏 移 。 通 过 相机 轨迹 选择 帧 
间 时 间 窗 ， 通 过 立体 视觉 建立 3-D 深度 图 。 而 仅 
基于 相机 的 大 场景 重建 的 挑战 在 于 漂移 与 循环 


第 二 部 分 ， 我们 来 解决 机 器 视觉 应 用 中 的 识别 
问题 。 其 中 主要 的 挑战 在 于 检测 到 一 个 物体 并 对 此 
进行 识别 或 分 类 。 因 为 机 器 人 应 用 中 感 兴趣 的 对 象 
总 是 处 在 一 个 复杂 的 环境 中 ,任何 算法 都 应 该 对 不 
属于 感 兴 趣 物体 的 部 分 不 敏感 。 目 前 主流 的 算法 是 


随 着 数码 成 像 速度 的 提高 与 成 本 的 降低 ， 相 机 已 


经 成 为 机 器 人 的 标准 配置 ， 也 应 该 是 其 中 最 便宜 的 传 


感 器 。 与 其 他 定位 (全 球 定位 系统 ，GPS) 、 惯 导 
(IMU) 和 距离 (声呐, 激光， 红外 等 ) 传感器 不 
同 ， 相 机 有 最 高 的 数据 带宽 。 一 个 最 简单 的 数码 录像 
机 的 带宽 也 可 以 达到 140Mbivs ( 按 每 秒 30 Wi, dj 
SY WER 640 x480， 每 个 像素 16 字 节 来 计算 ) 。 虽 然 
图 像 信 息 的 含义 没有 GPS 或 激光 那么 明确 ,但 是 其 


中 包括 的 信息 量 是 最 丰富 的 。 


地 点 的 任务 ， 给 定 


举 一 个 例子 ， 给 一 个 机 器 车 设 定 从 4 地 点 到 8B 
的 指示 是 一 系列 的 视觉 标志 和 /或 
GPS 航 点 。 机 器 人 从 A 地 出 发 ， 并 判断 哪里 是 可 通过 
区 域 。 利 用 两 幅 或 两 幅 以 上 的 图 像 ， 可 以 建立 场景 深 


基于 图 像 匹 配 的 ， 我们 选择 特征 并 表示 为 图 像 语 
言 ， 通过 比较 这 些 图 像 语 言 的 直方 图 来 计算 相似 


性 。 目 标识 别 还 有 很 长 的 路 要 走 ， 但 是 机 器 人 提供 
了 探索 这 一 问题 的 应 用 背景 和 平台 ， 在 识别 过 程 中 


发 挥 积 极 的 作用 。 
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度 图 或 地 形 图 ， 然 后 进行 障碍 4 


萄 的 检测 ， 从 而 完成 可 


通过 区 域 的 判定 。 在 行驶 过 程 中 ， 机 器 人 的 路 径 估计 
可 以 通过 一 种 由 相机 运动 来 构建 三 维 场景 的 方法 完 


成 。 通过 匹配 和 三 角 测 量 ， 


机 器 人 的 运动 轨迹 可 以 


a 


来 建立 环境 的 布局 ， 


还 可 以 作为 接 下 来 的 位 姿 佑 计 的 


参考 。 对 于 每 一 时 刻 ， 机 器 人 都 要 判断 环境 中 的 危险 


物 如 行人 ,或 去 寻找 类 似 垃圾 桶 的 标志 物 。 当 机 器 人 


被 绑架 或 无 法 识别 环境 一 段 时 间 后 ， 它 必须 意识 到 要 
结束 循环 或 重新 启动 系统 。 这 种 情况 可 以 通过 机 天 人 
对 周围 事物 和 环境 的 识别 来 判断 。 举 一 个 极端 的 例 


子 ， 通 过 保留 


辆 车 辆 对 所 到 的 所 有 地 点 的 轨迹 访 


问 ， 可 以 建立 一 个 城市 的 三 维 地 图 ， 这 是 视觉 实时 定 
位 和 语义 映射 问题 。 下 一 部 分 ， 我 们 介绍 3-D 运动 
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中 的 估计 与 地 图 重建 ， 物 体 的 识别 将 在 最 后 一 部 分 中 
进行 说 明 。 


23.1 三 维 视觉 和 基于 视觉 的 实时 定 


位 与 地 图 重建 


本 节 中 ， 我 们 假定 所 有 的 情况 都 是 在 单 目 或 双 
目 情况 下 发 生 的 。 如 果 我 们 假定 存在 主动 传感器 
(结构 光 投 影 ) 或 者 限定 机 器 人 的 活动 范围 ， 问 题 
考虑 起 来 会 简单 得 多 。 但 是 ,我 们 主要 针对 的 是 一 
般 场景 ， 而 将 这 些 假定 情况 留 给 读者 自己 研究 。 在 
与 其 他 传感器 融合 方面 ， 读 者 可 以 参考 第 21 、22 和 
36 章 中 的 传感器 以 及 第 20 章 中 提 到 的 GPS 和 惯 导 
装置 。 在 本 章 中 ,我 们 主要 是 提出 模型 ， 对 多 传 感 


5%) 。 在 许多 视觉 系统 ， 特 别 是 移动 机 器 人 中 ， 和 采 
用 的 广角 相机 会 带 来 图 像 的 径 向 畸变 ， 这 种 径 向 
畸变 可 以 用 多 项 式 表 示 。 这 时 ， 图像 坐标 要 用 如 
下 的 公式 表示 : 

x oy (l krk thr e) 


yi 2y (+hrthkr thr ++) 

AP, Pax tr, 

这 里 ， 我 们 和 暂时 假定 图 像 中 心 的 坐标 为 (0，0) 。 
在 式 中 的 原 图 像 坐 标 (xu. yi) 由 校正 后 的 坐标 
(Xa, Yan) TES 

利用 对 棋盘 格 标定 板 的 多 幅 图 像 来 获得 相机 的 内 
参 方 法 是 目前 被 广泛 采用 的 标定 方式 ， 且 已 经 出 现 标 
准 的 处 理工 具 ， 比 如 MATLAB 的 标定 工具 箱 ， 
OpenCV 的 张 氏 标定 方程 。 当 焦距 等 内 参 在 操作 


器 和 SLAM 的 精度 估计 分 别 放 在 第 25 章 与 第 37 章 。 
在 本 部 分 中 我 们 始终 假定 点 特征 相关 是 已 经 解决 的 
问题 ， 而 匹配 问题 和 特征 点 检测 在 目标 识别 部 分 
说 明 。 
首先 介绍 从 现实 世界 到 相机 平面 的 映射 。 假 设 在 
ERPE (X, Y, Z) 的 点 在 相机 c, 坐 标 系 中 的 
坐标 为 (XX,，Y,;，2Z,) ， 两 者 之 间 的 转换 关系 为 


X, X 
Y, |=R, UE 
Zi Z 


式 中 ，R, 是 旋转 矩阵 ， 其 坐标 值 代表 的 是 世界 坐标 
系 相 对 于 相机 坐标 系 的 旋转 ; t, 是 从 相机 坐标 系 原 
点 到 世界 坐标 系 原 点 的 平移 向 量 。 旋 转 和 矩阵 为 正 交 
矩阵 尺 尺 =1， 其 行列 式 值 为 1。 我 们 设 定 光 心 为 坐 
标 系 原点 ， 光 轴 为 相机 坐标 系 的 Z, 轴 。 如 果 我 们 假 
定 成 像 面 为 Z, = 1， 则 图 像 坐 标 (x, y) 可 以 表 
示 为 


(23.1) 


X, Y, 
Es SE 
在 实际 应 用 中 ， 我 们 用 像素 坐标 (Qu, vj) 来 表示 像 
素 的 位 置 ， 其 与 图 像 (x, y) 坐标 的 映射 关系 为 
u, = fax, * By, +c, v,=fy,te, (23.3) 
式 中 ，j/ 是 光 心 到 成 像 平面 的 距离 ， 也 叫 焦距 ， 两 
者 是 近似 相等 的 ; a 是 成 像 点 的 纵横 比 ， 它 是 由 非 
正方 形 的 传感器 单元 和 在 水 平和 竖 直 方向 上 的 采样 
频率 不 一 致 而 引起 的 ; 倾斜 因子 8 是 矫正 成 像 面 的 
稍 许 倾斜 ;图 像 中 心 c,，c, 是 光 轴 与 成 像 面 的 交点 。 
这 五 个 参数 为 相机 的 内 参 ， 获 得 这 几 个 参数 的 过 
程 称 为 内 参 标 定 。 对 一 个 已 经 标定 好 的 相机 ， 我 
们 用 图 像 坐标 (xu, y) 来 代 蔡 像素 坐标 (u, 


(23.2) 


x; = 


过 程 中 发 生变 化 或 者 被 观察 对 象 不 可 靠 时 ， 我 们 使 用 
Pollefeys 等 人 提出 的 最 新 方法 ”下 ， 当 所 有 的 参数 
都 未 知 的 时 候 ， 我 们 采用 Kruppa 方程 和 几 种 分 层 自 
标定 方法 全 * S. ， 此 方法 至 少 需要 三 个 视图 。 不 考虑 
径 向 畸变 的 情况 下 ， 上 面 提 到 的 映射 关系 可 以 归纳 成 
矩阵 形式 ， 设 定 图 像 坐标 到 =(u,, v, 1), 与 世界 
Abbe X-(X, Y, Z, 1) 可 以 得 到 

À;u; -K,(R,,t;)) X = PX (23.4) 
式 中 ，A; =Z.; 是 点 下 在 相机 坐标 系 中 的 深度 ; P 是 
3 x4 的 投影 矩阵 。 有 两 个 这 样 的 变换 方程 就 可 以 将 深 
度 变量 A 消除 。 


23.1.1 位 姿 估 计 


如 果 已 知 标 志 点 的 世界 坐标 筷 ， 我 们 就 可 以 计算 
它们 的 映射 ， 这 个 计算 未 知 的 旋转 与 平移 的 过 程 在 标 
定 中 称 之 为 位 姿 估 计 。 当 然 ， 这 是 在 标志 点 的 图 像 坐 
标 已 经 得 到 的 情况 下 进行 的 。 在 机 器 人 学 当中 ， 位 姿 
估计 可 以 当成 是 在 已 知 环境 下 的 定位 。 假 定 我 们 已 知 
相机 的 标定 参数 ， 和 N 个 点 的 世界 坐标 筷 -,，.w 和 对 
应 的 图 像 坐标 x, .wn。 定 义 场景 中 两 点 x,，x, 的 映 
射 夹 角 为 5, ， 如 图 23. 1 所 示 ， 设 两 点 之 间 的 距离 平 
FIX -于 必 为 者 ， 点 着 到 观察 点 的 距离 d, WARY 
余弦 定理 得 到 

d +d, -2d, d, cosó,, = di, (23.5) 

如 果 可 以 得 到 d, Al d,， 剩 下 的 问题 就 是 根据 式 

(23. 6) 


dx, = RX, +t (23.6) 
来 计算 相机 坐标 系 和 世界 坐标 系 之 间 的 旋转 和 平移 


变换 。 
在 式 (23.5) 中 有 两 个 未 知 变量 d 和 d,, ATV 
有 三 个 点 ， 我 们 就 可 以 完成 位 姿 估计 。 实 际 上 ， 三 个 
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dl 


AAA 


图 23.1 位 资 估计 问题 : 视 场 中 有 三 个 点 ， 点 到 相机 
的 距离 41 ，d。 和 ds 未 知 ， 但 是 各 射线 之 间 的 夹 角 已 
A, AZER, d, diid BA 


点 可 以 建立 含有 三 个 三 元 
组 解 。 

根据 一 些 经 典 解 决 方案 '*] ， 设 定 d, = ud,, 

d, =vd, ， 可 以 得 到 三 个 关于 d, 的 方程 
ds 
2a) +? -2uvcos;, 
di; 
ETT. — 2vcosÓ,, 
diy 
ETT - 2ucosó,, 

这 相当 于 求解 关于 w 和 vw 的 二 次 方程 组 。 方 程 组 
包含 两 个 方程 ， 其 中 包括 d,s 和 di 的 方程 称 之 为 E3, 
包括 di, 和 dis 的 方程 称 之 为 pl。 通过 求解 E3 来 获得 
uw, PURER WALA El 中 ， 从 而 不 用 开 根 号 就 可 以 
fu, 再 将 4 代 回 到 3 中 ， 从 而 得 到 一 个 关于 wv 的 
四 次 方程 。 该 方程 最 多 有 四 个 实 根 。 对 每 个 w， 我 们 
可 以 通过 任意 两 个 二 次 方程 获得 两 个 相应 的 wx， 因而 
用 上 述 方法 求解 的 话 ， 最 多 可 能 产生 8 组 实数 
解 所 1。 现在 通用 的 方法 是 采用 迭代 法 上 拓 "或 者 利 
用 更 高 维 的 线性 空间 "进行 求解 。 


三 角 测量 


即使 我 们 已 知 相机 的 内 外 参数 或 者 投影 矩阵 已 
我 们 还 是 无 法 从 单个 相机 中 恢复 一 个 点 的 深度 。 现 在 
我 们 有 一 个 点 下 在 两 个 相机 中 的 投影 


X 
Àu, | ) 

1 

X 
Ài, =z, (7) 


ERNER AERE P, PLAT, RAIDE A 


d, 


1 


23.1.2 


(23.7) 


况 ， 但 是 我 们 可 以 得 到 三 角 测 量 的 结果 而 不 需要 把 投 
影 矩 阵 分 解 为 内 部 参数 和 外 部 参数 。 

在 得 到 同一 个 空间 点 在 两 个 相机 坐标 系 的 位 置 ， 

且 已 知 投 影 和 矩阵 己 ， 忆 的 情况 下 ， 我 们 能 得 到 该 点 的 

两 个 投影 方程 。 值 得 注意 的 是 ， 每 个 点 提供 了 两 个 独 

立 的 方程 ， 这 就 使 得 三 角 测 量 成 为 对 于 两 个 视角 的 过 

约束 问题 。 这 与 实际 情况 并 不 矛盾 ， 因 为 从 两 个 相机 

光 心 中 发 出 的 两 条 射线 通常 在 空间 中 并 不 交 于 一 点 ， 

除非 它们 满足 极 线 约束 。 关 于 极 线 约束 ， 我 们 在 下 段 

进行 说 明 。 下 面 左 侧 矩 阵 的 秩 一 般 情况 下 为 4， 在 满 
足 极 线 约束 的 情况 下 ， 它 的 秩 为 3. 

xP,(3,:) -已 (1,:)N /xX 

yP,(3,:) -P,(2,:) || Y 

Z 

1 


=0 (23.8) 
xP,(3,:) -P,.(1,:) 


yP,(3,:) - P,(2,:) 
XB, PCI). 是 矩阵 己 的 第 ; 行 。 
显然 ， 上 面 的 齐 次 系统 可 以 转化 为 带 有 未 知 
(X, Y, Z) 的 非 线 性 系统 ， 否 则 ， 就 可 以 利用 奇异 
值 分 解 (SVD) 来 得 到 使 等 式 左边 最 接近 0 值 的 解 。 
参考 文献 [23. 12] 是 三 角 测 量 法 的 经 典 之 作 。 


23.1.3 移动 立体 视觉 


假设 一 个 刚性 的 立体 视觉 系统 由 左右 两 个 相机 组 
成 ， 安 置 在 移动 机 器 人 平台 上 ， 投 影 关 系 如 下 


u; - PX, (23.9) 
u, - PX, (23. 10) 

在 两 个 不 同 的 时 间 点 ， 观 察 系 统 可 得 
X, - R,X, «t, (23. 11) 


式 中 ， 马 是 空间 中 一 点 的 世界 坐标 ， 通 常 我 们 会 将 
世界 坐标 系 设 为 某 一 相机 的 相机 坐标 系 ; X 是 同一 
点 在 经 历 了 一 次 相机 运动 (R, £) 后 的 坐标 。 为 了 
估计 相机 的 姿态 变化 ,我们 要 解决 两 方面 的 匹配 问 
题 : 一 个 是 左右 图 像 之 间 的 匹配 ， 一 个 是 同一 相机 前 
后 帧 图 像 之 间 的 匹配 。 同 一 时 刻 左右 图 像 之 间 的 相关 
匹配 可 以 计算 空间 中 特征 点 的 位 置 。 而 通过 求解 式 
(23.11) 可 以 得 到 运动 参数 (R, 二) ， 我 们 称 之 为 
绝对 方向 。 同 样 的 ， 我 们 也 可 以 避免 第 二 次 三 角 测 
量 ， 而 通过 空间 中 已 知 位 置 的 点 和 左 图 上 点 的 位 置 关 
系 来 解决 位 姿 估 计 问 题 。 在 机 器 人 学 中 ， 与 此 相似 的 
是 利用 传感器 的 实时 定位 与 地 图 构建 (SLAM) 问题 
(第 37 章 ) ， 这 里 我 们 称 为 双 目 SLAM, 

移动 立体 视觉 的 描述 将 会 比较 简短 ， 读 者 可 以 去 


计算 点 对 的 空间 位 置 。 这 个 过 程 被 称 之 为 三 角 测量 。 
虽然 为 了 得 到 如 上 的 形式 ， 我 们 没有 考虑 畸变 的 情 


参考 距离 传感器 中 的 相似 的 论述 。 图 像 之 间 的 跟踪 建 
立 了 不 同时 刻 之 间 的 联系 ， 所 以 我 们 可 以 得 到 


an 


84 第 3 


X, - RX, «t 
根据 参考 文献 [23.13，14] 提出 的 标准 方法 ， 
通过 (点 集 ) 形 心 的 相 减 来 消除 平移 变量 ， 得 到 
X, - X, =R(X, -X,) 

我 们 至 少 需要 三 个 点 才 可 以 得 到 两 个 不 共 线 的 独 
eli X — X, WRIA n AP i5 4 891 PU e dE BLU 
3 xn WIERE A ,，， 我 们 可 得 到 如 下 的 最 小 化 费 罗 贝 
尼 乌 斯 (Frobenius) 范 数 的 方程 

jd Ha RA p 

这 是 一 个 普 鲁 克 问题 ,通过 奇异 值 分 解 (SVD) 方法 
BEAT WR ARO A ; 

R = sign( dt (UV ) ) UV" 
其 中 U,V 就 是 通过 奇异 值 分 解 得 到 的 : 

A,A, = USV' 

我 们 可 用 随机 抽样 一 致 (RANSAC) 算法 进行 求解 ， 
采集 3 xn 个 采样 点 ， 并 用 普 鲁 克 方法 进行 验证 。 


23.1.4 ”从 运动 信息 恢复 三 维 场景 (SfM) 


现在 ， 假 设 所 有 的 投影 矩阵 已 知 ， 关 注 相 关 点 
zu 和 ww, 的 测量 与 匹配 ， 即 著名 的 从 运动 信息 恢复 三 
维 场景 (SM) 问题 ， 更 精确 地 说 ， 从 2-D 运动 信息 
中 重建 3-D 运动 信息 与 结构 。 在 机 器 视觉 中 ， 这 是 
相对 定位 问题 。 即 使 我 们 在 式 (23.9) 中 消去 A 项 ， 
或 将 其 重新 写 为 


(23. 12) 


(23. 13) 


我 们 会 意识 到 如 果 (X, P, P) 是 一 个 解 ， 那 么 
(HX, P,H !, PB)H  ) 也 是 一 个 解 。 这 里 五 是 一 个 


4x4 的 可 逆 的 实数 和 矩阵， 也 就 是 说 在 P PRR, B 
使 在 实际 应 用 中 ， 我们 会 让 世界 坐标 系 与 第 一 个 相机 
一 致 ， 即 


u, - (10)X 
u, ~P,X 
我 们 保留 同样 的 歧义 ,五 的 形式 可 以 表现 为 
1 0 0 0 
0 1 0 0 
H- 5 0 1 0 (23. 15) 
hy hy hy hy 
其 中 hy, #0, PAE ASIRIA E REA DAL E E AE Ie Je 
任意 秩 为 3 的 矩阵 而 没有 加 以 约束 。 假 如 标定 的 相机 
参数 没有 问题 的 话 ， 那 么 投影 矩阵 只 和 位 移 有 关 ， 这 
时 唯一 的 模糊 量 就 是 尺度 


(23. 14) 


u, ~ (10)X 
u, ~ (Rt)X (23.16) 
除了 尺度 因子 hy =s#1, 互 很 像 一 个 单位 矩阵 ， 换 
名 话说 ， 如 果 CR, t, X) &— Aft, BBA (R, st, 
l/sX) 也 是 一 个 解 。 这 个 结论 可 以 推广 到 多 视图 的 
情况 中 。 因 为 对 于 机 器 人 ，(R, D 反映 的 是 自身 定 
位 ， 而 对 是 对 环境 的 结构 的 描述 。 这 个 问题 与 SLAM 
相似 ,但 是 SLAM 采用 的 是 多 传感器 ， 比 如 激光 或 者 
雷达 等 距离 传感器 ， 单 日 SLAM 可 以 更 好 地 描述 基于 
多 视图 的 SEM fia] COS 1 。 
1. 极 线 几何 
这 也 许 是 计算 机 视觉 中 被 研究 最 多 的 问题 了 ， 我 
们 只 涉及 其 中 关于 标定 的 部 分 ， 因 为 这 部 分 与 机 器 人 
应 用 关系 最 密切 。 射 线 Rx 与 x, 相交 的 充分 必要 条 件 
是 两 射线 与 基线 上 共 面 
xi(txRx,) =0 (23.17) 
这 就 是 外 极 线 约束 〈( 见 图 23.2) 。 这 里 为 了 避免 尺度 
上 的 模糊 ， 我 们 假定 上 是 单位 向 量 。 我 们 把 未 知 量 放 
到 一 个 矩阵 中 


E=îR (23.18) 
式 中 , f 是 一 个 3 x3 WEF t RIKE, E 矩阵 
是 基本 和 矩 阵 。 所 以 外 极 线 约束 写 为 

xiEx, =0 (23. 19) 
该 方程 可 以 解读 为 通过 点 x, 所 在 成 像 面 的 直线 的 参 
BCE Ex 或 者 通过 x 所 在 成 像 面 的 直线 的 参数 是 ET 
x;。 这 些 线 叫做 极 线 ， 它 们 分 别 形成 了 中 心 在 极点 
ei ，e; 的 光线 束 。 如 图 23.2 Stas, 极点 是 基线 与 两 
个 成 像 面 的 交点 ， 所 以 e, ~t, e, ~ - R"'t， 通 过 观察 
极 线 方程 ， 我 们 可 以 很 快 推出 Ee, 20, Ee, =0。 


图 23.2 


两 个 坐标 系 下 的 坐标 变换 
以 及 世界 到 相机 的 透视 投影 


XT BUR BJ SEA AB PEBU SE Gr 
£ -|Ec R?? | E-[t] xR, HP tes’ Re O(3)| 
(23.20) 
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我 们 认为 是 一 种 五 次 流 形 。 下 述 结果 已 经 在 参考 
文献 [23.16] 中 得 到 证 明 。 

命题 23.1 

一 个 至 E 民 的 矩阵 是 基本 和 矩阵 的 充分 必要 
条 件 是 它 含有 两 个 相等 的 奇异 值 ， 而 且 第 三 个 奇异 
值 是 0。 

我 们 在 这 里 介绍 一 种 最 近 由 Nister 提出 的 方 
TER ， 从 五 点 对 应 中 计算 基本 和 矩阵， 该 方法 由 于 适用 
于 随机 抽样 一 致 (RANSAC) 方法 而 获得 广泛 的 应 用 。 

2. 最 小 案例 

我 们 把 极 线 约束 扩展 到 齐 次 坐标 x = (s yi” 
Zs Xo = (X44 Yas 25) ( 当 点 不 在 z, =1 上 时 ) : 

(xxi yx zxi)E,-0 (23.21) 
式 中 , 五 .是 基本 矩阵 五 的 按 行 堆积 。 

当 我 们 仅 用 五 个 点 对 应 的 线性 齐 次 系统 时 ， 以 下 
数据 矩阵 的 四 维 核 空间 中 的 向 量 都 可 以 是 这 个 系统 
的 解 


E,-A,u,*À,u,*À,u,*A,u, (23.22) 

在 这 里 我 们 希望 由 E. 得 出 的 EE 是 个 满足 命题 23.1 的 基 

本 矩阵。 这 一 点 已 经 在 参考 文献 [23.16] 得 到 证 明 。 
命题 23. 2 

一 个 EeR”” 的 矩阵 当 且 仅 当 满足 以 下 条 件 

时 ， 它 是 一 个 基本 和 矩阵 


EE'E = ace (EE? )E 


虽然 ， 这 个 de (E) 20 约束 可 以 从 式 (23.23) 
推断 出 来 ， 我 们 仍 要 和 式 (23.23) 一 起 使 用 它 来 利 
用 五 中 的 10 个 3 次 方 方 程 。 如 参考 文献 [23.17] 中 
描述 ， 可 以 得 到 关于 入 的 10 级 多 项 式 。 这 个 多 项 式 
的 实 根 可 以 通过 施 图 姆 (Sturm) 序列 来 计算 。 目 前 
没有 证 据 证 明 对 于 所 有 的 情况 都 存在 一 个 实 根 。 

假设 我 们 已 经 从 相关 点 中 恢复 了 基本 和 矩阵 ， 下 一 
个 任务 就 是 恢复 一 个 正 交 和 矩 阵 R 和 这 个 矩阵 到 基本 
和 矩阵 的 平移 单位 向 量 t。 我 们 可 以 得 到 ， 如 E = USV" 
是 互 的 奇异 值 分 解 ， 并 且 det(U) >0，det(Y) > 0， 
那么 :与 U 的 最 后 一 列 平行 , REF UR,,V 或 者 
UR? V", KB R 表示 绕 z 轴 旋转 nm/2。 每 一 个 旋转 
都 相当 于 其 他 的 再 绕 基 线 旋转 半 周 。 选 择 正 确 配对 的 
旋转 和 平移 使 得 重建 点 在 相机 前 面 。 

3. 歧义 (二 义 性 ) 

当场 景 中 的 点 在 场景 中 处 在 一 个 平面 “或 者 
这 些 点 处 在 场景 中 ， 而 相机 中 心 对 称 地 处 在 双 曲 面 上 
时 中， 五 点 法 会 受到 一 些 限制 。 当 寻找 基本 和 矩 阵 


(23.23) 


的 精确 解 的 时 候 ， 无 论 我 们 用 多 少 点 来 求解 都 有 其 本 
质 的 模糊 性 。 

当 求 解 线性 最 小 二 乘 系统 的 基本 矩阵 时 ， 场 景 平 
面 以 及 所 有 的 点 和 摄像 机 中 心 都 在 一 个 二 次 曲面 上 ， 
并 且 两 个 相机 的 光 心 对 称 地 分 布 在 母线 的 两 侧 。 由 于 
对 应 点 和 相机 中 心 都 在 二 次 曲面 上 而 导致 秩 不 足 且 产 
生 无 穷 多 个 解 。 

除了 这 些 模糊 的 情况 ， 还 有 大 量 的 文献 提 到 了 双 
目 立 体 视觉 的 不 稳定 性 。 特 别 地 ， 在 参考 文献 
[23.18, 20, 21] 中 提 到 视 场 角 小 和 视 场 深度 变化 
小 会 导致 平移 与 坐标 轴 夹 角 佑 计 的 不 确定 性 。 一 个 小 
的 附加 旋转 可 能 是 平移 与 旋转 共同 作用 的 结果 ' 3 。 
另外 ,已经 证 明 在 全 局 最 优 解 附近 存在 的 局 部 最 优 解 
会 给 基于 迭代 的 算法 '*” 闻 带 来 干扰 。 


23.1.5 单 目 SLAM/ 多 视图 SfM 


当 谈 到 实时 定位 与 地 图 构建 (SLAM) 时 ， 我 们 
针对 的 是 一 段 相当 长 的 时 间 。 现 在 的 问题 是 如 何 将 多 
幅 图 像 信息 加 入 3-D 运动 估计 GEM) 过 程 中 。 

为 了 采用 多 幅 图 像 ， 我 们 引入 了 秩 (排名 ) 分 
类 限制 下 。 假 设 世 界 坐 标 与 第 一 帧 图 像 的 坐标 系 
一 致 ，x, 表 示 环 境 点 的 在 第 i 帧 的 映射 ， 其 深度 信息 
是 相对 于 第 一 帧 的 和 A, ， 则 有 : 

x, =R,(A,x,) +t; (23. 24) 
以 向 量 x, 的 叉 乘 为 例 ，n 幅 图 像 就 有 齐 次 系统 


x,xR,x, xt, 


A, 
p }20 (23.25) 
x, xR,x, xt, 
点 在 第 一 幅 图 像 的 深度 是 个 未 知 量 ， 这 个 3n x2 


的 多 视图 矩阵 的 秩 肯 定 是 1.”*' 这 一 约束 同时 满足 
极 线 约 束 和 三 焦点 方程 。 这 个 深度 值 的 最 小 二 乘 解 可 
以 很 容易 地 推导 出 来 


> (x, xt)" Gr x Rx) 
lx; x Rx, |f 

得 出 每 个 点 的 深度 后 ， 我 们 可 以 将 式 (23.25) 重新 

写成 


EE (23.26) 


1 IT ^l ^l 
Ax, Ox; xj 


^ 


Reed 
| | ) (23.27) 
t; 
MAON ox; 


式 中 , xtA n ERATES i 帧 中 的 坐标 ; R, t 
指 的 是 第 i 帧 相对 于 第 一 帧 的 运动 ，R*" 是 一 人 
12x1 的 向 量 ， 由 旋转 矩阵 RR, 大 加 而 成 。 设 定 是 这 


86 第 3 篇 


个 左 侧 的 3n x 12 矩阵 通过 奇异 值 分 解 得 到 的 核 ，4 
是 由 上 的 前 九 个 元 素 构 成 的 3 x3 RE, a 是 由 后 
三 个 元 素 构 成 的 向 量 。 为 了 得 到 旋转 和 矩阵， 我 们 利用 
式 (23.12) 解决 绝对 定位 问题 的 奇异 值 分 解 的 方式 
来 得 到 一 个 最 接近 正 交 算 阵 的 可 首 和 矩阵 。 

在 算法 的 后 期 ,我们 做 一 个 校正 来 最 小 化 真实 图 
像 坐标 与 重建 点 反映 射 到 图 像 坐标 之 间 的 差 值 。 对 于 
NN 个 点 和 MM 次 运动 ， —FE2N(M +1) 个 残 差 的 平方 
和 ,在 有 3N+6M -1 个 变量 未 知 的 情况 下 最 小 化 。 
Lourakis ^7! £g vr. Y T ye EC Wi As Fg ft D FE ER B E £X 
性 最 小 化 。 值 得 注意 的 是 ， 这 种 集束 校正 虽然 很 组 
慢 , 但 是 考虑 到 了 运动 估计 与 环境 (三维 点 ) 估计 
的 相关 性 ， 而 这 种 相关 性 在 式 (23.25) 的 迭代 策略 
中 被 人 为 地 隐藏 了 。 

Teler 一 2 通过 一 个 解 看 计算， 即 先 得 到 相对 旋 
转 最 后 计算 相对 位 移 ， 完 成 了 对 于 大 场景 的 运动 估计 
与 视图 重建 。 以 上 提 到 的 多 视图 SEM 技术 因为 它 的 批 
处 理性 质 只 能 应 用 在 滑动 时 间 窗 口上 。Davison'* 51 
通过 把 射线 方向 从 未 知 深度 中 解 而 出 来 ， 进 行 了 实时 
递 推 回 归 方法 。 


23.1.6 基于 立体 视觉 的 稠密 视差 图 计算 


在 本 部 分 ， 我 们 介绍 SLAM 中 的 M 部 分 ， 也 就 
是 我 们 如 何 从 立体 视觉 或 序列 图 像 中 获得 稠密 的 环境 
地 图 。 我 们 强调 地 图 的 密度 是 为 了 把 它 跟 视觉 SLAM 
区 别 开 ， 后 者 只 是 重建 了 一 些 标 志 点 。 

我 们 从 一 个 简单 的 例子 开始 ， 比 如 如 何 利用 光 轴 
平行 的 一 对 相机 来 得 到 稠密 深度 图 。 已 知 相机 的 投影 
矩阵 或 基本 矩阵， 我 们 可 以 随时 转动 这 两 个 相机 ， 使 
所 有 的 相关 点 都 在 图 像 的 同一 行 上 ， 我 们 称 这 个 过 程 
为 校正 池 。 极 线 几 何 的 知识 对 于 校正 来 说 已 经 足 
够 了 。 我 们 已 经 描述 过 如 何 根 据 相 关 点 计算 空间 点 的 
位 置 ， 所 以 现在 我 们 关注 如 何 解决 匹配 问题 : 对 于 所 
有 在 左 图 像 上 的 点 如 何在 右 图 像 上 找到 与 它 最 相似 的 
点 ,反之 亦 然 。 对 于 左 图 像 1, 和 右 图 像 1 的 邻 域 我 们 
有 相似 性 计算 函数 ， 相 对 应 的 两 邻 域 中 心 位 置 的 差 值 
叫做 视差 4。 每 一 种 相似 性 测量 方式 都 会 产生 一 个 关 
于 视差 与 图 像 位 置 的 对 应 关系 (x, ，d) ， 我 们 称 之 
为 视差 图 ”> 。 最近 的 基于 平面 扫描 的 方 
法 .下 利 用 一 种 不 同 的 思想 来 计算 相关 系数 ， 该 
方法 把 图 像 反 投影 到 前 平行 面 上 ， 计 算 这 些 平行 面 的 
层 间 距离 而 不 是 视差 图 。 这 种 反 投影 除了 需要 极 线 几 
何 外 ， 还 需要 一 种 不 同 的 校正 。 相 似 性 函数 的 选择 与 
计算 区 域 的 大 小 直接 影响 了 最 后 得 到 的 视差 图 ， 而 且 
根据 所 允许 的 计算 时 间 ， 它 也 可 以 是 复杂 的 ， 非 线性 


的 。 男 外 计算 区 域 的 选择 ， 隐 含 地 说 明了 视差 在 一 个 
邻 域内 是 不 变 的 。 这 样 的 假设 会 在 图 像 中 不 连续 的 区 
域 产 生 一 些 错误 ， 除 非 使 用 偏 置 双 边 聚 集 方法 


23.36] 
o 


(offseted bilateral aggregation) | 

计算 图 像 视差 图 的 时 候 ， 给 每 个 像素 分 配 视差 的 
各 种 方法 之 间 的 区 别 在 于 该 方法 是 基于 局 部 优化 还 是 
全 局 优化 的 。 在 局 部 优化 中 ， 单 个 点 的 视差 值 与 其 他 
点 无 关 ， 其 中 经 典 的 算法 是 贪 禁 算法 ， 它 是 在 对 应 的 
扫描 线 中 找到 与 自身 最 相似 的 。 全 局 优化 算法 中 ， 一 
次 计算 整 行 的 像素 ”或 者 对 整个 图 像 建 立 一 个 
代价 函数 来 计算 。 代 价 函 数 会 包括 数据 项 和 平滑 项 ， 
还 有 中 断 保持 步骤 。 为 每 一 个 像素 贴 上 一 个 视差 标签 
是 一 个 NP 问题 ,目前 两 种 主流 的 解决 方式 是 图 
39-109 gH fe Re Poe P OM! 

视差 图 在 三 种 情况 下 存在 困难 : 遮挡 ， 纹 理 少 和 投 
影 缩减 效 应 或 者 不 遵守 朗 伯 反射 引起 的 同一 区 域 的 表现 
差异 。 随 着 基线 变 长 ， 最 后 一 种 情况 会 变 得 很 突出 。 
在 局 部 最 优化 方法 中 ， 解 决 遮挡 的 方法 是 双向 窗口 
或 左右 一 致 性 检测 。 遮 挡 的 最 佳 解决 方法 是 动态 规划 法 
( 见 图 23.3)， 它 的 优点 是 它 的 实时 性 。 该 方法 假定 视差 
是 关于 像素 位 置 的 单调 函数 ， 也 就 是 说 ， 如 果 我 们 有 双 
点 一 视差 对 x, di, May, dd, WAR «x, <x,, ABA 
d, <d,。 男 外 一 个 约束 是 唯一 性 约束 ， 其 他 所 有 的 方法 
也 包含 此 约束 。 这 个 约束 表明 ， 左 图 像 上 的 一 点 在 右 图 
像 上 只 能 找到 一 点 与 之 匹配 ， 反 之 亦 然 。 好 多 人 尝试 克 
服 该 方法 仅 考虑 一 维 匹 配 的 不 足 。 其 中 最 成 功 ， 而 且 在 
立体 视觉 中 地 位 很 高 的 是 半 全 局 方法 汪汪 ， 其 在 很 多 
方向 上 计算 代价 值 ， 如 图 23. 4 所 示 。 


HH 


图 23.3 立体 视觉 中 的 动态 规划 方法 T 的 关 
键 是 图 像 的 代价 矩阵 中 的 最 优 路 径 选 择 CM 表示 
左右 图 像 匹配 成 功 , L 5 R 分 别 表示 只 在 左 图 像 
或 右 图 像 中 可 见 ) 
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a) b) 


图 23.4 半 全 局 方法 代价 值 计算 
a) 视差 空间 中 的 最 小 能 耗 路 径 
b) 16 个 方向 上 的 能 耗 集合 [3 


当 使 用 多 个 连续 视觉 序列 时 ， 比 如 说 ， 已 给 定 的 
相机 轨迹 ,我 们 可 以 把 所 有 的 深度 图 联系 起 来 形成 一 
尽 可 能 与 所 有 视角 的 观测 一 致 的 3-D 模型 。 多 视 
立体 技术 全 具有 多 相机 的 优点 〈 多 相机 可 以 环 
绕 在 物体 周围 )， 可 以 计算 出 物体 的 可 视 外 壳 ， 利 用 
光度 一 致 性 很 好 的 恢复 深度 ”1 。 在 机 器 人 学 的 范 
蝴 里 ， 我 们 很 少 有 环绕 式 的 信息 捕 损 ， 但 是 一 样 可 
以 通过 带 有 运动 控制 的 运动 视觉 系统 得 到 多 视图 
Es 


Auto 


m 


7 


23.2 识别 


无 论 机 器 人 执行 什么 任务 ， 它 必须 能 够 知道 
物体 在 环境 中 的 位 置 并 且 识 别 相 关 的 物体 、 空 间 
结构 与 发 生 的 事件 。 视 觉 提供 了 很 多 关于 周围 环 
境 的 信息 ， 所 以 基于 视觉 的 识别 对 机 器 人 来 说 是 
一 种 基本 能 力 。 一 般 意 义 的 视觉 识别 是 一 件 很 难 
的 事情 。 在 没有 其 他 约定 条 件 下 ， 单 是 定义 物体 
的 构成 就 很 复杂 所 。 如 果 再 加 上 物体 的 分 类 的 
话 ， 这 个 问题 将 更 加 复杂 。 目 标识 别 是 计算 机 视 
觉 中 一 个 重要 的 问题 ,为 了 解决 识别 问题 ,人 研究 
者 提出 了 很 多 方法 ， 但 是 还 有 好 多 的 问题 或 待 
解决 。 

溺 运 的 是 ， 在 许多 情况 下 ， 机 器 人 不 需要 解决 很 
复杂 的 目标 识别 与 分 类 问题 。 确 切 地 说 ， 机 内 人 的 任 
务 通常 是 寻找 已 知 的 或 者 已 见 到 过 的 物体 ， 比 如 在 目 
标 跟 踪 、 导 航 与 操纵 中 的 应 用 ， 还 有 一 些 情况 会 涉及 
地 标的 识别 ， 道 路 等 特殊 结构 的 识别 。 这 些 任务 都 包 
含 目 标识 别 ， 但 主要 工作 是 计算 不 同 图 像 间或 图 像 与 
已 知 模型 间 的 相关 性 。 还 有 一 些 任务 是 判断 物体 的 类 
别 和 属性 ， 道 路 识别 就 属于 这 个 范畴 。 物 体 的 分 类 是 
一 个 更 加 困难 的 问题 。 通 常 意义 的 分 类 问题 当然 还 包 
括 对 各 个 类 别 的 定义 ， 但 是 这 不 在 我 们 讨论 的 范围 


之 内 。 

关于 基于 计算 机 视觉 的 目标 识别 与 分 类 的 文献 
有 很 多 ， 自 从 计算 机 视觉 诞生 那天 起 就 提出 了 大 量 
方法 。 随 着 时 间 的 流逝 ， 有 些 方法 被 完善 ， 有 些 方 
法 被 遗忘 。 比 如 ， 基 于 纯 统计 的 模式 识别 方法 在 早 
期 很 受 欢 迎 ， 在 二 十 世纪 七 十 年 代 ， 由 于 三 维 重 建 
与 物理 几何 模型 的 备 受 关注 ， 统 计 的 方法 被 忽视 ， 
但 是 随 着 计算 机 技术 的 强大 和 其 在 机 器 学 习 中 的 优 
势 ， 该 方法 又 被 重新 重视 起 来 。 回 顾 所 有 的 现存 方 
法 需要 厚 厚 的 几 卷 而 不 是 几 章 的 空间 。 所 以 ， 在 下 
节 中 我 们 只 介绍 几 种 对 机 器 人 应 用 特别 有 效 的 方法 。 
我 们 给 出 了 一 些 好 的 综述 文献 ， 比 如 参考 文献 
[23. 49] ， 参 考 文献 [23.50], ， 可 作为 各 种 方法 的 
切入 点 并 进行 扩展 ， 虽 然 这 些 参考 文献 更 强调 分 类 
而 非 识别 。 


23.2.1 识别 方法 研究 


早期 的 目标 识别 方法 用 三 维 模型 来 描述 物体 或 
者 把 物体 分 解 成 面 或 单位 基 元 。Roberts 和 Guz- 
man ^? 首先 做 出 了 尝试 ， 从 简单 的 几何 部 分 来 考 
虑 问题 。 Binford ”1 引入 了 广义 圆柱 体 ， 该 方法 被 
Brooks' 5 引入 到 ACRONYM 系统 中 ， 随 后 被 应 用 
到 Marr 与 Nishihara EA! rp 5€, 这些 方法 都 是 以 
物体 为 中 心 进行 表达 ， 以 达到 观察 的 不 变性 。Marr 
等 人 WY 司 认 为 利用 立体 视觉 、 单 目的 序列 图 像 和 直 
接 的 距离 图 像 ， 可 以 从 二 维 图 像 得 到 环境 的 三 维 结 
构 。 Faugeras Ak E2581 H Bolles 45 (23-57) HE Bi] f A BEY 
SEF ABA Biederman ^? 提出 了 一 种 基于 局 部 
识别 (RBC) 的 理论 来 从 二 维 图 像 中 识别 人 体 。 他 
的 工作 促进 了 RBC 方法 在 计算 机 中 的 应 用 。 但 是 从 
二 维 图 像 中 提取 所 需 的 原始 几何 轮廓 是 件 困难 的 事 。 
第 一 步 的 边缘 提取 很 少 能 直接 得 到 有 用 的 指导 信息 。 
在 ACRONYM 系统 中 ， 该 问题 是 利用 高 级 推论 来 解 
He AY 在 Mohana 与 Nevatia ^ 9? 还 有 Zisserman 等 
人 中 中 的 系统 中 ， 边 缘 被 分 组 然后 进行 形状 的 推 
Wr. Æ Nelson 和 Selinger ^5 PEH 的 另 一 个 系统 中 采 
用 了 相同 的 原理 ， 但 是 直接 进行 了 目标 表示 而 没有 
其 他 的 中 间 步 又 。 更 多 先进 的 基于 骨架 的 目标 
示 和 形状 分 析 方法 被 提出 来 ， 这 些 方法 通常 需 
一 个 轮廓 曲线 ， 所 以 需要 先进 行 分 制 。 这 些 识 别 
方法 的 影响 力 因为 他 们 基于 物体 中 心 的 表达 而 受 
到 影响 。 

现在 识别 方法 已 经 转向 以 观察 者 为 中 心 的 表达 。 
实际 上 ， 在 人 体 的 识别 中 关于 这 种 表达 方式 的 定位 
存在 着 一 场 争论 (Tarr 和 Bülthoff °°!) 。 在 计算 机 
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视觉 中 ， 这 种 方法 回归 了 非常 早期 的 基于 模式 的 识 
别 方法 ， 而 兴起 于 人 脸 识别 的 研究 中 (Turk 和 Pent- 
land ^9!) 。 人 工 神 经 网 络 是 与 之 齐 肩 的 先进 识别 
方法 (Poggio 和 Edelman’? ) 。 通 过 对 同一 物体 不 
同 角度 的 训练 可 以 得 到 很 好 的 识别 率 。Maurase 与 
Nayart*” 1 引领 了 基于 统计 与 学 习 的 方法 ,该 方法 
一 直 在 发 展 与 完善 。 很 显然 ， 目 前 的 焦点 已 经 转移 
到 由 Rao 和 Ballard ^* ^ 提出 的 从 全 局 到 局 部 的 方 
法 。 具 有 判别 力 及 生成 力 的 模型 已 经 被 提出 ， 它 可 
以 应 用 在 目标 分 类 与 识别 中 。 男 外 ， 关 于 结构 和 部 
分 更 明确 的 描述 也 被 纳入 其 中 。 这 种 现在 被 称 为 星 
群 方法 的 引入 实际 上 减少 了 基于 局 部 与 基于 外 观 特 
征 的 方法 的 差异 ， 而 且 隐 含 了 非常 早期 的 多 模板 匹 
配方 法 (Fischler 和 Elschlager ?* 9": ) 。 不 过 ， 在 方法 
描述 的 最 后 ， 我 们 认为 所 谓 的 基于 外 观 的 ， 基 于 局 
部 的 ， 基 于 星 群 的 方法 是 强调 了 目标 识别 的 不 同 
方面 。 

23.2.2 ”基于 外 观 的 识别 


基于 外 观 的 方法 通过 提取 图 像 中 的 显著 特征 来 进 
行 目标 的 识别 。 在 模式 识别 与 图 像 处 理 中 ， 特 征 定义 
为 N 元 组 或 矢量 ， 其 元 素 是 原始 模式 变量 的 函数 值 
或 其 中 的 子 集 ( Haralick 和 Shapiro’ 9! ) 。 特 征 可 以 
针对 图 像 的 全 局 或 者 局 部 进行 计算 ， 但 是 对 于 机 器 人 
应 用 来 说 ， 局 部 特征 是 最 合适 的 。 我 们 要 选择 那些 显 
著 的 特征 进行 匹配 。 因 此 ， 特 征 检 测 与 特征 计算 是 各 
自 独立 的 步 又 。 

正如 在 模糊 特征 部 分 提 到 的 ， 在 图 像 的 若干 个 位 
置 上 计算 的 特征 应 该 不 随 观察 者 与 场景 移动 而 变化 。 
所 以 ,不管 是 在 计算 机 视觉 还 是 机 器 人 中 ， 点 、 线 、 
由 线 等 几何 特征 被 广泛 使 用 。 这 些 特征 可 以 通过 对 图 
像 方程 求 导 来 计算 ， 还 有 很 多 特征 可 以 通过 派生 函数 
来 计算 (Lindeberg 9) ) 。 实 际 上 ， 可 以 定义 一 系列 
关于 图 像 函数 的 微分 不 变量 。 但 是 ， 简 单 的 点 特征 ， 
甚至 线 这 样 更 扩展 的 特征 ， 只 能 局 部 表述 其 所 在 区 域 


出 的 尺度 不 变 特征 变换 (SIFT) 就 是 通过 计算 局 部 
亮度 信息 得 到 的 。 然 而 ， 为 了 达到 对 光照 不 敏感 的 目 
的 ， 这 些 方法 中 都 首先 进行 了 光照 估计 ， 而 且 完 全 没 
有 用 到 颜色 信息 。 利 用 颜色 信息 又 可 以 增加 一 些 特 
性 ,但 即使 已 有 可 计算 的 光照 恒 常 模型 ， 恢 复 物体 表 
面 不 受 光 照 影响 的 颜色 特征 被 证 明 仍 是 一 件 很 困难 的 
事情 。 不 管 怎样 ， 颜 色 特 征 仍 然 是 具有 区 别 力 的 。 通 
常情 况 下 ， 在 实际 应 用 中 不 同 特征 选择 是 根据 图 像 条 
件 及 场景 内 容 决定 的 。 

1. 显著 特征 

找到 感 兴趣 的 点 进行 匹配 的 想法 是 由 Moravec 在 
参考 文献 [23.75] 中 提出 来 的 。 他 的 方法 被 Harris 
和 Stephens ^ ”| 改进 ， 成 为 我 们 今天 常用 的 Harris ffi 
Agar. At T DR BI 


È dd, n 
w= * esc 
LL È 


(23.28) 

式 (23.28) 中 的 和 矩阵 特征 值 是 与 图 像 工 的 自 相 

关 主 曲率 成 正比 的 。 当 两 个 曲率 值 都 高 的 时 候 ， 说 明 

该 点 是 图 像 上 的 一 个 角 点 ， 这 一 特性 受 光 照 的 影响 比 

较 小 。 总 的 来 说 ， 这 个 检测 器 表示 了 局 部 方向 的 分 

dg, TE Forstner [23.7] 和 Bigiin 与 Granlund' ”的 文章 

中 分 别 对 此 进行 了 介绍 。 高 斯 函数 可 以 用 在 窗口 和 微 
分 中 ， 这 时 算 子 可 以 写成 如 下 的 形式 


M -E( * ,0,0,) 
n z Tp) LL( * | 
-o56(o,) : 
lLi*ie di 0p) 


(23. 29) 
式 中 ,0o, 和 o, 是 高 斯 核 函数 在 时 间 窗 和 微分 上 的 尺 
度 因 子 。 这 个 矩阵 是 羊 正定 的 矩阵 ， 其 特征 值 A,， 
A,20, Ens 


M=A,+A, (23. 30) 
表示 该 点 对 检测 算 子 的 响应 强度 。 其 特征 向 量 最 大 特 


的 特征 。 所 以 ， 像 对 应 匹配 这 样 的 问题 ， 我 们 需要 更 
丰富 的 局 部 描述 算法 来 解决 。 此 外 ， 不 仪 需要 特征 在 
运动 及 小 角度 观察 变化 时 的 不 变性 ， 还 需要 它们 对 光 
照 变化 ， 大 尺度 运动 及 距离 变化 不 敏感 。 最 近 的 特征 
提取 和 表述 方法 都 考虑 了 以 上 的 要 求 ( Lowel*”|， 
Schmid 和 Mohr 7"! , Mikolajczyk 和 Schmid ^ ?! , Ma- 
tas AP 71 — Mikolajezyk 4095713. 经 过 几 十 年 的 发 
展 ， 特 征 的 提取 已 经 取得 了 很 好 的 效果 。 特 征 及 特征 
描述 符 都 是 针对 小 区 域 的 点 等 之 类 的 几何 特征 进行 计 
算 的 。 在 感知 区 域 , 计算 各 种 性 质 ， 比 如 ，Lowe 提 


征 值 的 方向 是 该 点 在 邻 域 的 梯度 最 大 方向 。 而 且 
det( M) =A,A, (23.31) 
可 以 计算 该 点 的 散 度 。Harris 检测 算 子 可 以 用 如 下 的 
Hessian 和 矩阵 来 代替 
LC * ,05) 
LC: "d 


(23.32) 

该 检测 算 子 会 在 斑点 (点 块 ) 和 边缘 处 得 到 更 

强 的 响应 (细节 参看 Lindeberg’?! 或 者 Lowe ^ 3] Js 
但 是 它 自 然 需要 二 阶 导 数 。 这 里 的 特征 值 与 灰 度 分 布 


= i Tp) 
H-H( ° ,0,05) = 
| . Tp) 
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的 主 曲 率 成 正比 而 且 可 以 通过 矩阵 的 迹 与 行列 式 来 计 也 就 是 说 


Jk. Lowe ^7" Fil FI BEIT iE, 8X 3 RAE fH DU DU 
率 来 去 除 边缘 处 的 点 。 

2. 寻找 特征 点 的 鲁 棒 方 法 

这 些 检测 算 子 依赖 于 尺度 而 且 对 尺度 很 敏感 。 为 
匹配 寻找 合适 的 特征 点 因此 需要 找到 在 空间 和 尺度 上 
响应 都 强 的 点 。 例 如 ， 在 三 维 空 间 中 的 极 值 点 搜索 。 
Lindeberg’) 提出 了 一 种 尺度 特征 的 概念 来 解决 这 个 
问题 ， Mikolajczyk 与 Schmid!” ?) 和 Lowe 7^ 791 ik y 
了 解决 该 问题 的 高 效 方法 。Mikolajczyk 与 Schmid 首先 
利用 Harris 角 点 检测 算 子 得 到 二 维 图 像 中 的 特征 点 ， 
然后 对 这 些 点 进行 各 尺度 的 Laplacian 变换 ， 选 择 那 
些 响应 高 的 点 作为 最 终 的 结果 。 这 个 检测 算 子 一 一 
Harris- Laplacian 算 子 ， 在 当前 流行 的 点 检测 算 子 中 具 
有 最 好 的 尺度 变化 重复 性 。 

Lindeberg 提出 的 方法 需要 经 尺度 因子 归 一 化 的 
Laplacian 算 子 来 获取 尺度 不 变量 ， 而且 Mikolajcky 的 
实验 表明 ， 这 个 o V2 G 的 极 值 使 得 该 检测 算 子 相 较 
于 其 他 检测 算 子 ， 可 以 得 到 对 尺度 最 不 敏感 的 特征 。 
Lowe 提出 了 一 种 高 效率 的 近似 计算 方法 ， 利 用 高 斯 
ZNAT (DOG) 来 代替 。 这 种 斥 度 空 间 的 计算 过 
程 如 图 23.5 所 示 。 引 进 影 响 因子 大 有 


D( + ,8) =G( + kt) -G( * t) | (23.33) 
从 热 传 递 方程 可 得 
aG 
VG (23.34) 
因此 


高 斯 差分 (DOG) 


高 斯 
图 23.5 各 种 尺度 下 的 高 斯 差分 算 子 
图 23.5 中 ， 在 每 一 个 尺度 空间 ， 对 原始 图 像 进 行 连 
续 的 高 斯 卷 积 ， 生 成 左 图 所 示 的 一 序列 高 斯 图 像 ， 相 
邻 的 高 斯 图 像 相 减 生成 了 右 图 所 示 的 高 斯 差分 图 像 
(DOG) 。 在 某 一 尺度 完成 计算 后 ， 高 斯 图 像 以 比例 因 
子 2 进行 降 采 样 得 到 新 的 图 像 。 


D=(k-l)&eVG (23. 36) 

Lowe 的 高 效 算 法 是 利用 一 系列 的 DOG 图 像 的 近 
似 来 寻找 特征 点 。 这 些 操 作 的 结果 是 一 系列 的 关键 点 
的 坐标 ， 以 及 其 对 应 的 尺度 和 方向 。 这 些 提 到 的 算 子 
不 是 仿 射 不 变 的 ， 但 是 可 以 进行 改进 达到 这 个 目的 ， 
Mikolajczyk @ A U^" GRAY, SAT, TE GN Lowe 
指出 的 那样 ， 在 很 多 情况 下 ， 至 少 在 场景 中 有 足够 多 
的 显著 特征 的 时 候 ， 算 子 可 以 适应 描述 符 ， 并 不 需要 
仿 射 变换 。 

3. 显著 区 域 

Matas 等 .3 下 提出 了 一 种 寻找 显著 区 域 的 方法 ， 
该 方法 在 长 基线 下 的 匹配 和 物体 识别 中 都 得 到 了 很 好 
的 实验 结果 。 它 是 基于 最 稳定 极 值 区 域 ( MSER ) 
的 ， 与 被 阔 值 分 割 的 图 像 相连 。 下 面 会 详细 说 明 阔 值 
分 割 的 方法 。 极 值 区 域 是 说 所 有 处 在 最 稳定 极 值 区 域 
内 的 像素 都 有 比 周转 区域 的 像素 高 (或 低 ) 的 像素 
值 。 这 个 性 质 很 稳定 ， 所 以 被 用 来 计算 最 优化 的 分 割 
BE., 

如 Mate 等 人 在 参考 文献 [23.73] 中 提 到 的 ， 极 
值 区 域 有 一 系列 的 非常 好 的 性 质 。 比 如 ， 它 们 不 受 亮 
度 的 单调 或 仿 射 变化 影响 ， 而 且 在 连续 的 图 像 几何 变 
换 中 可 以 保持 拓扑 结构 。 所 以 它们 在 许多 常见 但 是 还 
没有 很 好 地 被 描述 的 几何 与 光学 变化 中 是 稳定 的 。 

我 们 按照 Mate 等 人 在 参考 文献 [23.73] 中 的 描 
述 来 说 明 该 算法 。 对 一 幅 定 义 在 DD 的 数值 图 像 1， 值 
为 S$， 通 常 定 位 为 0 ~255 之 间 的 值 。 极 值 区 域 D 是 这 
样 一 个 区 域 : 如 果 peD, ge9D, MA I(p) »I(q) 
(最 大 极 值 区 域 ) 或 者 1(p) <q) 〈 最 小 极 值 区 域 ) 。 

为 了 定义 稳定 极 值 区 域 ， 我 们 认为 有 一 系列 层 层 
EW XRD, CCD, CD C…， 如 果 区 域 D* 是 
最 稳定 的 ， 那 么 意味 着 q 在 i 取得 最 大 值 ， 其 中 

qi) = |D; I\|D, ,IID| (23.37) 
而 | ， | 是 表示 集合 的 势 (或 基数 ); h 是 该 方法 的 
参数 。 

这 些 层 层 秋 套 的 区 域 可 以 通过 依次 对 图 像 用 一 个 
超过 S 的 阔 值 分 割 得 到 。 我 们 可 以 用 一 种 直接 的 方式 
来 说 明 这 种 区 域 的 获得 方法 。 首 先 ， 按 亮度 保存 像 
素 ， 接 着 按照 增加 或 减少 的 方式 来 把 它们 放置 到 图 像 
上 去 ， 那 些 相连 着 的 像素 和 他 们 所 在 的 区 域 被 保存 下 
来 ， 例 如 ,用 一 种 高 效 的 结构 单元 寻找 方法 二 2 。 
如 果 S 是 一 个 小 的 离散 集合 ， 比 如 0，…，255， 这 
个 方法 就 是 线性 的 ， 而 且 可 以 得 到 高 效 的 执行 。 需 
间 出 的 是 ， 虽 然 极 值 区 域 可 能 是 杂乱 的 ， 但 是 MESR 
操作 只 会 保留 那些 十 分 简单 的 区 域 ， 这 对 下 一 步 的 计 
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算 非 常 重要 。 

这 种 方法 不 需要 求 导 就 可 以 得 到 显著 结构 。 其 他 
类 似 的 方法 有 : Kadir 和 Brady 提出 的 检测 算 子 3 3 ; 
Smith 和 Brady 提出 的 SUSAN ARMATIS, 
及 数学 形态 学 方法 。 

4. 显著 点 与 显著 区 域 的 描述 符 
正如 前 面 介 绍 的 那样 ， 合 适 的 检测 算 子 可 以 找 出 
感 兴趣 点 与 区 域 , 来 提供 图 像 的 区 域 信 息 。 所 以 
Lowe 利用 尺度 信息 来 检测 一 个 椭圆 区 域 ， Matas 等 人 
检测 凸 起 的 MSER， 而 Mikolajczyk 等 执行 了 一 个 仿 射 
标准 化 来 获得 不 同 图 像 中 的 可 比较 区 域 。 

很 多 基于 区 域 的 描述 符 被 提出 用 来 进行 基于 外 观 
的 物体 识别 。 有 基于 区 域 图 像 本 身 的 站， 这 是 一 
种 统计 方法 (Schiele 与 Crowley. 91) 。 而 更 多 的 是 一 
种 基于 滤波 的 方法 (Rao 5j Ballard ^  ) 。 二 阶 导 数 
矩阵 在 运动 及 形状 计算 上 的 成 功 表明 了 利用 方向 统计 
WEZH, Lowe? "的 SIFT 特征 中 提出 了 一 种 特别 
有 用 的 描述 符 。 
这 些 描述 符 对 显著 点 进行 计算 (这 些 点 可 以 用 
前 面 草 节 提 到 的 算法 ) ， 得 到 相关 斥 度 关键 点 。 为 
了 计算 与 图 像 旋 转 无 关 的 关键 点 ， 这 些 关 键 点 首先 
被 假定 一 个 方向 。 值 得 提出 的 是 ， 这 和 Schmid 与 
Mohr'”" 提 到 的 旋转 无 关 测量 方法 不 同 。Lowe' 7 
利用 在 梯度 直方 图 中 寻找 极 值 的 方式 来 计算 方向 ， 
梯度 的 权 值 跟 梯 度 的 模 成 正比 。 峰 值 对 应 着 该 区 域 
的 梯度 方向 。 如 果 这 些 峰 值 几乎 都 达到 最 高 值 ， 则 
同时 存在 几 个 峰值 也 是 可 以 接受 的 。 因 此 ， 一 个 图 
像 点 会 对 应 好 几 个 特征 描述 符 。Lowe 设 定 极 值 的 
80% 为 闷 值 并 保存 两 个 峰值 。 实 验 显示 同时 保存 4 
个 峰值 也 是 很 有 用 的 。 有 兴趣 的 读者 可 以 见 参考 文 
Wk [23.70]. 

经 过 这 些 步骤， 我 们 得 到 一 系列 与 位 置 、 尺 度 和 
方向 有 关 的 关键 点 。 在 这 个 关键 点 周围 的 每 个 窗口 内 
的 点 ， 我 们 重新 计算 梯度 的 模 与 方向 。 在 关键 点 的 
nxn 区 域内 用 kx 种 模式 来 计算 ， 用 一 个 高 斯 函数 
的 直方 图 来 衡量 这 些 值 ， 如 图 23. 6 ras, Lowe EE 
考 文献 [23.70] 中 使 用 的 是 n=k=4， 而 图 23.6 中 
展示 的 是 n=4, 有 =2。 共 对 应 有 8 种 方向 。 更 多 计 
算 方法 与 参数 选择 的 细节 可 以 参考 这 篇 文章 。 一 个 重 
要 的 方面 是 区 域 测量 方法 的 选择 ， 还 有 它 与 关键 点 检 
测 尺度 有 什么 联系 。 这 些 在 文章 中 都 有 讨论 ， 在 
Matas“ A.) Fl Mikolajczyk 等 人 中 的 文章 中 也 对 
此 进行 了 讨论 。 后 者 的 文章 在 讨论 对 于 仿 射 不 变性 的 
检测 算 子 时 还 引入 了 仿 射 的 标准 化 变换 。Zovrwe 在 他 
的 文章 中 同样 讨论 了 这 种 变换 的 用 处 。 


关键 点 描述 符 


图 像 梯度 

图 23. 6 关键 点 描述 符 
关键 点 描述 符 是 为 了 描述 关键 点 周围 每 个 采样 点 的 梯度 与 
方向 分 布 ， 各 点 的 权重 用 高 斯 函数 计算 ， 如 左 图 所 示 。 然 
后 如 右 图 所 示 ， 这 些 采样 点 在 4 x4 大 小 的 邻 域 内 进行 梯度 
方 
邻 


向 的 加 和 ， 形 成 梯度 方向 直方 图 。 每 个 箭头 的 长 度 是 该 
邹 域 内 对 应 方向 上 梯度 模 的 相 加 。 图 中 显示 的 是 8 x8 大 小 
的 样本 区 域 生成 2x2 的 描述 符 阵列 。 同 理 ，16 x 16 大 小 
的 区 域 生成 4 x4 的 描述 符 阵列 。 


统计 关键 点 周围 方向 的 思想 同样 用 在 特征 识别 
上 ， 在 这 里 ， 认 为 物体 (特征 ) 可 以 表示 为 中 心 点 
周围 的 一 种 模式 的 想法 是 自然 而 然 的 。 

5. 图 像 块 及 局 部 直方 图 作为 特征 

上 文 提 到 了 一 种 直接 利 图 像 块 作为 局 部 特征 的 方 
法 是 一 种 替代 及 补充 。 当 然 ， 在 使 用 这 种 方法 之 前 可 
以 选择 感 兴 趣 点 来 减少 计算 量 。Agarwal 和 Roth’? * 
提出 了 一 种 基于 图 像 块 编码 的 方法 ， 后 来 被 Leibe 
等 (3 中 和 其 他 作者 推广 。 

图 像 块 保存 了 局 部 图 像 的 结构 ， 但 是 这 也 表明 
了 ， 把 图 像 块 里 的 信息 用 直方 图 表示 出 来 或 许 更 有 利 
于 物体 的 识别 与 定位 。Swain 和 Ballard" ^ 2 给 出 了 基 
于 颜色 比较 的 识别 的 例子 。 但 是 ， 他 们 直接 利用 
RGB 空间 的 数据 ， 结 果 证 明 ， 这 些 数 据 对 光照 变化 
敏感 。Schiele 和 Crowley" 551 用 接受 域 计 算 输 出 的 直 
方 图 代替 ， 接 受 域 计 算 通 过 一 阶 高 斯 微分 算 子 或 三 个 
尺度 上 的 微分 不 变量 来 实现 。Schneiderman 和 Ka- 
nade 7 3 的 研究 表明 可 以 通过 小 波 系数 的 直方 图 来 
获得 人 脸 和 车 辆 的 有 效 区 域 。 最 近 Linde 和 Linde- 
berg' ”介绍 了 高 阶 导 数 的 直方 图 并 表明 它们 计算 起 
来 很 有 效 。 总 的 来 说 ， 这 类 方法 使 用 起 来 简单 ， 而 且 
在 局 部 变量 足够 多 的 情况 下 得 到 了 很 好 的 实验 结果 。 更 
多 此 类 方法 的 说 明 请 参看 Koenderink 和 Van Doorn!” ?! H 
文章 ,介绍 了 局 部 无 规律 图 像 的 概念 。 通 过 比较 直方 
图 的 方法 在 统计 学 领域 广为人知 。 对 于 此 类 技术 ， 
Ruber 和 Tomasi ^?" 给 出 了 精彩 而 简明 的 概述 。 


23.2.3 匹配 
基于 视觉 的 识别 也 就 是 将 从 图 像 中 提取 出 来 的 特 
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征 或 量 和 已 经 存储 的 物体 的 表示 形式 进行 匹配 与 比 
对 。 作 为 模式 识别 问题 ， 这 一 个 经 典 而 且 被 广泛 研究 
的 问题 在 绝 大 多 数 关 于 图 像 及 信号 处 理 的 教科 书 中 者 
有 涉及 。 随 着 新 的 特征 技术 的 发 展 及 其 应 用 的 不 断 增 
加 ， 该 问题 近年 来 吸引 了 很 多 研究 者 的 目光 ， 而 且 也 
有 很 多 创新 的 工作 出 现 。 其 中 的 一 些 将 在 星 群 算法 中 
作为 其 基础 算法 被 讨论 。 这 里 我 们 对 一 些 特 征 和 外 观 
识别 中 用 到 的 识别 算法 进行 说 明 。 
1. 基于 词汇 的 方法 
直接 利用 SIFT 这 样 的 描述 符 来 匹配 意味 着 在 高 
维 空间 中 寻找 最 近 的 邻 域 , 计算 起 来 复杂 。 所 以 ， 
Lowe 和 其 他 人 利用 聚 类 的 方法 去 创建 一 个 类 似 字母 
表 的 东西 。 这 种 信息 表示 方式 适合 一 般 的 信息 检索 
方法 。 
为 了 给 一 个 图 像 数 据 库 建立 索引 ，Sivic 和 Zisser- 
man!” ”| 将 一 种 矢量 量化 区 域 的 描述 符 引 入 到 k- 35] 
值 聚 类 中 ， 并 且 这 些 聚 类 作为 视觉 词 应 用 到 文本 检索 
方法 中 。 通 过 给 出 一 个 从 训练 图 像 得 到 的 词汇 表 ， 从 
新 图 像 中 就 可 以 提取 描述 符 并 根据 最 近邻 法 进行 归 
类 。 用 这 种 方法 ， 可 以 很 快 得 到 新 图 像 的 匹配 结果 。 
Sivic 和 Zisserman 把 这 个 方法 应 用 到 录像 检索 中 去 ， 
但 是 该 方法 对 其 他 集合 中 的 图 像 也 好 用 。 利 用 词 频 - 
逆向 文件 频率 (TF-IDF) 方法 进行 的 文本 检索 还 是 
有 一 定价 值 的 ( Baeza- Yates 与 Ribiero Neto 2:981 Jo 
Nister 与 Stewenius ^?! 对 这 项 技术 进行 了 扩展 ， 从 而 
增强 了 它 的 适用 范围 ， 下 面 我 们 将 介绍 这 种 方法 。 
2. 利用 词汇 树 的 识别 
Nister 与 Stewenius ^?! 说 明了 一 种 分 级 的 TF- 
IDF。 在 该 方法 中 词汇 树 由 一 些 分 级 的 词汇 定义 。 他 
们 得 到 了 一 个 高 效 的 视觉 词汇 查找 表 ， 所 以 可 以 使 用 
一 个 更 大 的 词汇 表 ， 从 而 可 以 改进 检索 的 性 能 ( 见 
图 23.7) 。 


图 23.7 三 级 词汇 树 ， 有 10 个 节点 ， 
用 400 个 特征 去 描述 每 幅 图 像 


词汇 树 是 用 分 级 的 k- 均 值 聚 类 来 建立 的 , k 是 树 
的 分 级 (36) 因子 。 树 上 的 一 个 分 支 上 的 向 量 对 应 
一 个 视觉 词 。 为 了 计算 新 图 像 的 得 分 ， 我 们 需要 计算 
它 的 描述 符 与 词汇 树 上 分 支 的 相似 程度 。Nister 和 
Stewenius 提出 了 一 种 方法 ， 给 树 上 的 每 个 节点 i 设 定 
一 个 权重 ， 比 如 ， 基 于 炉 的 方法 ， 人 然后 根据 权 值 定义 


检索 值 g 和 数据 库 向 量 。 
qi = h;Oj 
d, =m,o, 


式 中 , n FI we PE PR oe, HELE DE 
价 如 下 : 


lall Ila] 


d 
sad = ht Tal 


i 的 方式 计算 权 值 : 


(23. 38 ) 


Qj fe 


N; 

AP, N 是 数据 库 中 图 像 的 数量 ，N, 是 数据 库 至 少 有 
一 个 描述 符 向 量 通过 节点 的 图 像 数 量 。 该 方法 对 于 拥 
有 几 千 幅 图 像 的 数据 库 图 像 获 得 了 高 质量 的 实时 实验 
结果 。 

相关 的 利用 词汇 表 的 金字 塔 匹 配方 法 可 以 参看 
Granuman 和 Darrell ^9? 的 文章 。 他 们 在 两 组 特征 向 
量 之 间 进 行 近似 部 分 匹配 。 需 要 说 明 的 是 这 些 方法 主 
要 解决 图 像 检 索 问 题 ， 找 出 最 相似 的 图 像 。 为 了 定位 
的 目的 ， 我 们 需要 更 进一步 的 精确 匹配 。 
3. 高 维 的 特征 匹配 
正如 前 面 提 到 的 ， 高 维 空间 中 的 特征 匹配 是 困难 
的 。 但是， 这 个 问题 已 经 有 所 进展 。 理 论 上 讲 ， 高 维 
空间 中 精确 的 定位 最 近邻 思想 会 导致 穷 举 搜索 。 近 似 
的 方法 也 被 提出 ， 如 Beis 与 Lowe 3.%] 和 Indyk 与 Mot- 
wani ^^? ， 但 是 他 们 都 需要 平衡 计算 速度 与 近似 精 
度 的 问题 。 最 近 Omercevic 45 7 1 提出 了 一 种 方法 来 
解决 这 个 问题 ， 他 们 的 方法 基于 有 意义 最 近邻 思想 。 
这 些 近邻 应 该 与 被 查询 特征 十 分 接近 ， 而 与 背景 特征 
的 分 布 相差 很 多 。 这 种 思想 基于 寻找 任意 离 群 点 的 分 
布 轨迹 并 用 指数 函数 来 描述 ， 所 以 那些 最 近邻 可 以 用 
它们 与 被 查询 点 的 相似 和 与 背景 的 差异 来 衡量 权重 ， 
点 的 内 积 被 用 来 计算 特征 向 量 间 的 相似 程度 。 作 者 还 
介绍 了 一 种 基于 稀 玻 编码 的 查询 方法 ， 在 保证 算法 速 
度 和 精度 的 前 提 下 ， 获 得 一 种 比 其 他 算法 更 优越 的 近 
似 算 法 。 例 如 ,虽然 速度 慢 于 词汇 树 方 法 ,但 是 在 同 
一 数据 库 上 该 方法 有 更 好 的 识别 性 能 。 


23.2.4 星 群 算法 基于 局 部 的 识别 
前 面 说 到 了 基于 特征 和 外 观 方法 的 成 功 ， 也 提 到 
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了 因为 其 对 物体 部 分 的 定义 和 定位 上 存在 的 问题 ， 
基于 局 部 的 识别 不 再 受到 那么 多 关注 了 。 然 而 ， 利 
用 结构 信息 明显 的 优势 ， 使 得 这 个 问题 又 受到 关注 。 
在 本 市 中 ,我 们 将 讨论 本 领域 中 的 最 新 进展 。 我 们 
会 关注 那些 利用 了 各 部 分 结构 关系 的 算法 ,但 是 并 
不 假定 各 部 分 一 定 对 应 某 种 几何 结构 。 事 实 上 ， 结 
果 证 明 ， 从 这 个 角度 出 发 ， 基 于 局 部 的 和 基于 外 观 
的 识别 方法 的 区 别 并 不 明显 ， 至 少 当 所 谓 的 外 观 指 
的 是 物体 的 部 分 而 不 是 物体 整体 的 时 候 是 这 样 的 。 
Forsyth 和 Ponce 在 他 们 的 书 中 把 这 类 方法 称 为 是 基 
于 结构 模板 间 关 系 的 方法 ， 这 里 的 模板 可 以 是 二 维 
或 三 维 空间 中 的 几何 形状 ， 也 可 以 是 亮度 、 颜 色 、 纹 
理 这 类 的 视觉 外 观 特性 。 

一 个 物体 的 几何 结构 可 以 用 它 各 个 部 分 的 集合 以 
及 各 部 分 的 连接 关系 进行 表达 。 部 分 对 之 间 的 连接 关 


系 可 以 用 一 个 无 向 图 GCV, E) 来 表示 ， 其 中 项 点 
v-iu, vena v, | 对 应 各 个 部 分 ， 边 (vj, vi) < 五 表 


示 vw 和 vw 是 相连 的 。 举 个 例子 ,一 个 物体 可 以 用 结构 
配置 了 = (1 ，…, L) 来 表示 ,1 表示 wv; 部 分 的 位 置 。 
有 许多 方法 可 以 参数 化 这 些 位 置 ， 简 单 的 可 以 直接 用 
其 在 二 维 或 三 维 图 像 中 的 位 置 和 各 部 分 的 夹 角 来 表 
示 。 这 种 使 用 部 分 的 方法 是 很 有 优势 的 。 通 过 对 部 分 
的 使 用 可 以 提供 一 种 模块 化 的 表示 方法 ， 而 且 同 一 个 
部 分 可 以 被 多 个 物体 共享 。 既 然 部 分 很 简单 ， 相 比 整 
个 物体 它们 用 很 少 的 变量 就 可 以 表达 ， 所 以 对 姿态 不 
敏感 。 更 好 的 是 ， 有 遮挡、 混乱 以 及 光照 变化 一 般 不 会 
影响 所 有 部 分 的 识别 。 

不 过 ， 还 有 两 个 重要 的 问题 需要 解决 。 一 个 我 们 
已 经 讨论 过 了 ， 就 是 各 部 分 的 检测 与 定位 问题 ， 第 二 
个 是 角 点 匹配 ， 通 常 这 是 一 个 计算 比较 复杂 的 问题 。 
Fischler 与 Elschlager ^ "认为 在 图 像 域内 这 是 一 个 能 
量 最 小 化 问题 。Felzensschwalb 与 Huttenlocher 在 参考 
文献 [23.99] 中 对 这 种 方法 进行 了 如 下 描述 。 

一 个 给 定 结构 配置 的 能 量 取决 于 图 像 数据 和 部 分 
的 匹配 结果 和 部 分 与 模型 之 间 的 符合 程度 。 给 定 一 幅 
图 像 ，m,(1;) 表示 部 分 v 被 分 配 到 1, 的 不 符合 程度 ， 
对 两 个 相连 的 成 分 ， 定义 d;(l;， L) 来 衡量 vw 被 分 配 
定位 到 上 ， 而 * 被 分 配 到 1 而 产生 的 形变 程度 。 模 型 
到 图 像 的 最 优化 匹配 可 以 定义 为 : 


i = arg min( > m,(1,) + 5 dj(1,1,) ) 
i=l "mE 
(23. 39) 
这 种 表达 说 明 要 最 小 化 各 个 部 分 的 匹配 代价 与 各 
相连 部 分 之 间 的 形变 代价 的 加 和 。 如 果 形 变 代价 只 和 
两 部 分 之 间 的 相对 位 置 有 关 的 话 ， 那 么 这 个 模型 不 随 


全 局 的 变化 而 变化 。 

这 类 方程 的 问题 是 通常 情况 下 没有 有 效 解 。 当 物 
体 结构 复杂 ， 特 别 是 非 刚 性 部 分 多 的 时 候 ， 需 要 的 参 
数 也 很 多 。 现 在 我 们 用 概率 模型 来 解决 这 些 问 题 ， 也 
就 是 靠 概率 来 估计 各 个 部 分 的 位 置 ， 而 不 是 通过 精确 
的 计算 。 估 计 是 通过 对 局 部 的 外 观 学 习 和 配置 的 先 验 
知识 来 计算 的 。 这 使 得 统计 公式 要 包括 部 分 确定 与 配 
置 问题 。 为 了 初始 化 这 类 算法 ， 还 是 需 用 以 下 的 方法 
给 这 类 算法 一 个 好 的 初始 假定 值 。 

假设 9 是 定义 物体 的 一 系列 参数 , 二 是 配置 ， 比 
如 是 各 部 分 的 定位 。P(7 JL, O) 表示 的 是 给 出 的 物 
体 在 图 像 7 的 概率 分 布 。 根 据 贝 叶 斯 定理 ， 物 体 结构 
配置 出 现 的 后 验 概 率 分 布 为 : 

P(L|1,0) «P(1|L,@)P(L|@) (23.40) 

IP, PCL | O) 是 物体 结构 配置 分 布 的 先 验 概 率 。 
正如 Felzenschwalb 与 Huttenlocher ^ 9 所 yi, 匹配 
问题 可 以 归纳 成 一 个 能 量 最 小 化 问题 ， 在 这 里 也 可 以 
认为 是 一 个 最 大 后 验 概率 估计 问题 。 为 此 ， 在 他 们 提 
出 了 一 种 有 效 的 方法 。 在 他 们 的 框架 中 ,模型 的 参数 
fff O-(u, E, c), 其 中 以 = | ,也 是 外 观 参 
A, E 是 连接 两 个 部 分 的 边 , c= le, | (v vj) EE} 
是 边 的 连接 参数 。 这 些 参数 通过 在 一 系列 训练 图 像 中 
利用 最 大 似 然 估 计 学 习 得 到 。 这 种 形式 的 能 量 最 小 化 
一 般 是 NP 问题 ,但 是 Felzenschwalb 与 Huttenlocher Fl 
用 图 描述 的 都 是 一 个 严格 限定 的 结构 的 事实 给 出 了 一 
种 高 效 的 算法 。 在 Fergus’? WT VER, AAS UL, 
地 点 和 尺度 来 获得 参数 ， 而 不 用 任何 图 来 表示 任何 结 
构 。 他 们 方法 的 目的 是 识别 一 类 目标 而 不 是 某 个 单个 
的 例子 。 


23.2.5 地 点 识别 与 地 形 分 类 


定位 是 移动 机 器 人 的 根本 问题 ， 它 包括 持续 的 位 
姿 估计 与 全 局 定位 这 两 方面 ， 有 时 也 被 称 为 “机 器 
人 绑架 ”问题 。 这 些 问 题 一 般 在 SLAM 背景 中 介绍 。 
视觉 是 基础 的 技术 形式 ， 而 它们 的 适用 方式 在 很 大 程 
度 上 取决 于 其 他 可 用 信息 的 类 型 。 无 论 何 种 情况 ， 应 
用 视觉 可 以 解决 地 标的 检测 和 识别 ， 还 有 全 局 定位 问 
题 ， 而 且 包 括 物体 识别 和 图 像 检索 的 很 多 方面 。 因 此 ， 
前 面 章 节 中 介绍 的 一 些 技术 也 可 以 应 用 到 这 些 情况 中 。 

尺度 不 变 的 关键 点 和 SIFT 特征 已 经 被 Kosecka 应 
用 ， 他 们 通过 识别 地 点 完成 了 室内 的 全 局 定位 ， 
并 且 用 HMM 方法 从 地 图 中 的 邻近 关系 寻找 信息 。 
Wolf 等 人 在 参考 文献 【23. 102] 中 提出 了 相似 的 方 
法 。 其 他 人 也 已 经 用 直方 图 描述 场景 。Ulrich 和 
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Nourbakhsh''”1 计 算 全 方位 摄影 图 像 的 彩色 直方 图 3 由 Fei- Fei Li, Antonio Torralba 和 Rob Fergus 编写 的 教 
并 且 与 存储 的 图 像 匹 配 ， 得 到 一 个 拓扑 地 图 的 预测 。 程 。Nister 的 词汇 树 方 法 .31 是 实例 识别 方法 中 最 具 
这 样 ， 通 过 一 个 简单 投票 过 程 可 以 得 到 接近 实时 的 性 实时 性 及 代表 性 的 方法 。 


能 。 这 个 方法 被 成 功 地 应 用 于 室内 外 环境 中 。David- 我 们 将 以 一 个 运动 和 深度 重建 的 系统 作为 结束 来 
son 和 Murray ^^ "' 3848 Bajesy ^ 的 主动 知觉 模式 。 展示 现在 的 研究 水 平 ， 参考 文献 [23.108] 中 的 工 
主动 地 利用 可 控 摄 像 机 寻找 室内 目标 。 作 展 示 了 在 没有 使 用 其 他 传感器 的 情况 下 利用 单 目 序 


学 习 是 地 点 识别 的 中 心 问题 。 在 大 多 数 情况 下 ， ” 列 图 像 进行 大 范围 的 深度 重建 的 技术 水 平 。 相 机 的 位 
要 一 些 训练 图 像 使 得 机 器 识别 更 加 鲁 棒 。 此 外 ， 在 姿 是 通过 应 用 参考 文献 【23.17] 中 的 算法 得 到 的 。 
识别 过 程 中 ， 也 可 以 利用 地 图 信息 或 近似 的 位 置信 ”获得 一 个 当前 的 位 姿 ， 一 个 时 间 窗 后 的 后 续 位 姿 利 用 
息 。 在 参考 文献 [23.106] 中 Ramos 提出 一 种 贝 叶 ” 先 验 性 的 RANSACI 1 方法 进行 估计 ， 然 后 得 到 一 
斯 方法 来 解决 这 些 问题 。 因 此 ， 他 们 的 方法 需要 的 训 个 重新 初始 化 的 新 的 三 重视 图 。 一 个 深度 图 像 是 通过 
练 图 像 很 少 ， 一 般 是 3 ~10 个 ， 并 且 不 依靠 地 图 。 图 把 扫描 空间 中 突出 的 点 进行 反 投影 得 到 的 。 图 23. 8 
像 被 分 为 很 多 小 块 ， 世 界 环境 被 认为 是 一 个 很 多 地 点 。 显示 的 是 一 个 多 个 深度 图 通过 中 值 融 合 且 考虑 到 了 可 
的 集合 ， 每 个 地 点 都 有 一 个 概率 性 的 描述 ， 在 接近 实 WEARER 
时 的 时 间 里 进行 匹配 。 他 们 首先 在 场景 中 的 一 个 小 块 
描述 上 进行 降 维 处 理 ， 然 后 通过 期 望 最 大 化 算法 ， 在 参考 文献 
一 系列 线性 混合 模型 的 结果 中 提取 出 一 个 生成 性 的 概 


Ej 
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本 章 介绍 视觉 伺服 控制 ， 视 觉 伺服 控制 是 指 在 
控制 机 器 人 运动 的 伺服 环 内 采用 计算 机 视觉 数据 。 
我 们 首先 介绍 目前 本 领域 中 已 成 熟 的 基本 技术 ， 然 
后 给 出 视觉 伺服 控制 问题 的 公式 化 的 总 体 概 述 ， 介 
绍 两 种 原型 的 视觉 控制 方案 : 基于 图 像 的 和 基于 位 
置 的 视觉 伺服 控制 方案 。 然 后 ， 为 推动 先进 技术 ， 
讨论 这 两 种 方案 的 性 能 和 稳定 性 问题 。 在 众多 已 有 
的 先进 技术 中 ， 我 们 讨论 2. 5-D、 混 合 、 分 块 和 开 
关 方 法 。 在 介绍 了 大 量 控制 方案 后 ， 我 们 转 而 以 简 
短 地 介绍 目标 跟踪 和 关节 空间 的 直接 控制 问题 作为 
本 章 的 结束 。 


NI 


24.1 视觉 伺服 的 基本 要 素 eee 97 
24.2 ”基于 图 像 的 视觉 伺服 mA 98 
24.2.1 A HABRE eem 98 
24.2.2 交互 矩阵 的 近似 MM 99 
24.2.3 IBVS 的 几何 解释 MM 101 
24.2.4 稳定 性 分 析 MM 101 


视觉 伺服 (Visual Servo, VS) 控制 是 指 采 用 计 
算 机 视觉 数据 去 控制 机 器 人 的 运动 。 视 觉 数据 可 由 摄 
像 机 获取 。 摄 像 机 可 直接 安装 于 机 器 人 操作 臂 上 或 者 
安装 在 移动 机 器 人 上 ， 在 这 两 种 情况 下 ， 由 摄像 机 的 
运动 均 可 以 推导 出 机 器 人 的 运动 。 摄 像 机 也 可 固定 安 
装 于 工作 空间 内 ， 这 样 摄像 机 可 以 通过 固定 配置 观测 
机 器 人 的 运动 。 其 他 配置 也 值得 考虑 ， 例 如 安装 于 偏 
转 一 俯仰 云 台 上 观测 机 器 人 运动 的 多 人 台 摄 像 机 。 在 数 
学 上 ， 所 有 这 些 情 况 的 分 析 是 类 似 的 。 所 以 ， 在 本 章 
中 我 们 将 主要 集中 于 前 者 ， 即 所 谓 的 “手眼 系统 ” 
(Eye-in- Hand) 。 

视觉 伺服 控制 依赖 于 图 像 处 理 、 计 算 机 视觉 、 控 
制 理论 等 技术 。 本 章 中 ,我们 将 主要 处 理 控制 理论 问 
题 ， 并 在 适当 的 时 候 与 前 述 各 章 建立 联系 。 


24.1 视觉 伺服 的 基本 要 素 
所 有 基于 视觉 的 控制 方案 的 目的 是 将 误差 e(1) 


24.2.5 立体 视觉 系统 的 IBVS see 103 
24.2.6 ”图像 点 柱 面 坐标 的 IBVS e 88 103 
24.2.7 其 他 几何 特征 的 IBVS pp 103 
24.2.8 EB 104 
24.83 基于 位 置 的 视觉 伺服 pp 105 
24.4 先进 方法 eH 106 
24.4.1 混合 视觉 伺服 e 106 
24.4.2 分 块 视觉 伺服 ………… cece ee eee eee eenees 108 
24.5 性 能 优化 与 规划 n 108 
24.5.1 优化 控制 与 元 余 框 架 MM MM MM 108 
24.5.2 FRET BR MH 109 
24.5.3 特征 轨迹 规划 Be 109 
24.6 3-D Jl MH 110 
24.7 目标 跟踪 MM 110 
24.8 ”关节 空间 控制 的 Eye- in- Hand 和 
Eye-to- Hand 系统 eee X9 111 
24.9 HRY MM 112 
DIDA Ew 112 
最 小 化 ， 误 差 的 典型 定义 如 下 
e(t) 2s[m(t),a] -s* (24. 1) 


该 公式 非常 通用 ， 正 如 下 面 所 看 到 的 那样 ， 它 包括 了 
很 多 方法 。 式 (4.1) 中 的 参数 定义 如 下 : 矢量 
1(1) 是 一 个 图 像 测量 集 (例如 ， 兴 趣 点 的 图 像 坐 标 ， 
或 者 一 些 图 像 片断 的 参数 )。 这 些 图 像 测量 结果 用 于 
计算 个 视觉 特征 的 矢量 s(m(1), a), 其 中 , a 是 
一 个 参数 集 ， 代 表 了 系统 的 潜在 附加 知识 (例如 ， 
粗略 的 摄像 机 内 参数 或 者 目标 的 三 维 模型 )。 矢 量 s* 
为 含有 特征 的 期 望 值 。 

现在 ,我 们 考虑 这 种 情况 ， 即 一 个 姿态 固定 且 无 
运动 的 目标 ， 其 s* 为 常数 ,s 的 变化 仅 依赖 于 摄像 机 
运动 。 而 且 ， 我 们 此 处 仅 考虑 控制 一 个 六 自由 度 摄像 
机 运动 的 情况 〈 即 摄像 机 安装 于 六 自由 度 机 器 人 操 
作 辟 的 末端 )。 在 随后 的 小 节 中 ， 我 们 将 处 理 更 一 般 
的 情况 。 

视觉 伺服 方案 主要 在 s 的 设计 上 不 同 。 在 24.2 
节 和 24.3 节 ， 我们 介绍 经 典 的 方法 ,包括 基 于 图 像 
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的 视觉 伺服 (Image-Based Visual Servo, IBVS) 控 
iil, Hes 由 图 像 数据 中 直接 得 到 的 特征 构成 ;基于 位 
置 的 视觉 伺服 ( Position- Based Visual Servo, PBVS) 
控制 ,其 s 由 三 维 (3-D) 参数 构成 ， 三 维 参数 必须 
从 图 像 测量 中 估计 。 我 们 将 于 24.4 节 提 供 几 种 更 加 
先进 的 方法 。 

一 旦 选 定 s， 控 制 系 统 方案 的 设计 将 变 得 非常 简 
单 。 或 许 , 最 直截了当 的 方法 是 设计 一 个 速度 控制 
器 。 为 了 设计 速度 控制 器 ， 需 要 建立 s 的 时 间 导 数 与 
摄像 机 速度 之 间 的 关系 。 将 摄像 机 的 空间 速度 记 为 
v=(v.，@.)， 其 中 ,vwv, 是 摄像 机 坐标 系 原点 的 瞬 
时 线 速度 ，w 是 摄像 机 坐标 系 的 瞬时 角速度 。8 与 
v, 的 关系 如 下 


$ -Ly, (24.2) 
RP, Le ROMA s REWER, 
在 视觉 伺服 参考 文献 [24.2] 中 有 时 也 称 为 特 
征 雅 可 比 矩 阵 。 本 章 中 ， 我 们 将 采用 后 面 的 术语 
将 s 的 时 间 导 数 与 关节 速度 联系 在 一 起 ( 见 24.8 
节 ) 。 
由 式 (24.1) 和 式 (24.2), ， 可 以 得 到 摄像 机 速 
度 与 误差 时 间 导 数 之 间 的 关系 : 
e =L,yv, (24.3) 
AP, L, =L EVA v, 作为 机 器 人 控制 器 的 输入 ， 
如 果 我 们 愿意 尝试 使 得 误差 以 指数 解 耦 下 降 (Hle = 
-Ae)， 则 由 式 (24.3) 得 
vy, = -AL/ e (24.4) 
AP, L? e RU, EN L, 的 摩尔 一 潘 洛斯 
(Moore-Penrose) {4 IEE ME, 3 L, 具有 全 秩 6 时 ， 
Li = (L7L,) LU, 该 选择 允许 上 e -AL,L; e || Al 
lv. | 最 小 化 。 当 大 =6 时 ， 如 果 det L, 40, WARE 
BL, Wait, JPA PEM v, = - AL; 'e。 
在 真实 的 视觉 伺服 系统 中 ， 实 际 上 不 可 能 真正 知 
id L, RL? 。 因 此 ， 需 要 实现 对 这 两 个 矩阵 之 一 的 近 
似 或 者 估计 。 因 此 ， 我 们 把 交互 矩阵 近似 矩阵 的 伪 逆 
和 交互 矩阵 伪 逆 的 近似 矩阵 用 符号 Me 表示 。 采 用 该 
符号 后 ， 控 制 律 实际 上 变 成 
»,2-AL?e- -AL!(s-s") (24.5) 
将 回路 闭环 ， 并 假设 机 器 人 控制 器 能 够 很 好 地 实 
Mv, 将 式 (24.5) 代入 式 (24.3), 有 


@ = -ALL:e 
该 方程 刻画 了 闭环 系统 的 实际 行为 ， 当 工 . 工 : AT, I, 
它 不 同 于 特定 的 行为 (e = -Ae)。1 是 6 x6 的 单位 


(24.6) 


矩阵。 这 也 是 采用 李 亚 普 诺 夫 (Lyapunov) 理论 进行 
系统 稳定 性 分 析 的 基础 。 

上 面 给 出 的 是 大 部 分 视觉 伺服 控制 器 采用 的 基 
本 设计 ， 其 所 缺乏 的 是 具体 细节 。 例 如 ，s 应 该 如 
何 选择 ? L 具有 什么 形式 ?应 该 如 何 估计 工 : ? 形 
成 的 闭环 系统 的 性 能 特性 如 何 ? 这 些 问 题 在 本 章 的 
后 续 部 分 予以 解决 。 我 们 首先 介绍 一 下 两 种 基本 的 
Jrik, IBVS 和 PBVS， 其 原理 已 在 20 多 年 前 提 
HUS. AUS, 我们 给 出 一 些 最 近 提 出 的 改进 其 性 
能 的 方法 。 


基于 图 像 的 视觉 伺服 


24. 2 


fic RA E T AVR £8 HTT R”, HH M ARP 
点 的 图 像 平面 坐标 定义 集合 s。 图 像 测量 结果 m 通常 
是 这 些 图 像 点 的 像素 坐标 (尽管 不 是 唯一 选择 )， 在 
式 (24.1) 中 定义 的 s=s(m, a) 中 的 a， 只 不 过 是 
摄像 机 的 内 参数 ， 用 于 从 以 像素 表示 的 图 像 测量 结果 
转换 为 特征 。 


24.2.1 交互 矩阵 


对 于 摄像 机 坐标 系 中 一 个 坐标 为 X= (X,Y,，2) 
的 3-D 点 ， 其 在 图 像 中 的 投影 为 一 个 坐标 为 x = (x, 
y) 的 二 维 (2-D) 点 。 于 是 ， 有 
x=X/Z=(u-c,)/fa 
Lae, 
式 中 , m=(u, v) 是 图 像 点 以 像素 为 单位 表示 的 坐 
标 ; a=(c,, cp, f, a) 是 摄像 机 的 内 参数 集合 ， 其 
定义 见 第 23 章 : c, 和 c, 是 主 点 坐标 ，f 是 焦距 ， 
a 是 像素 维 的 比率 。 第 23 章 中 定义 的 内 参数 B， 此 处 
假设 为 0。 在 此 情况 下 ， 取 s =x=(x,，y)， 即 点 的 图 
像 平面 坐标 。 成 像 几何 与 透视 投影 的 细节 ， 在 很 多 
计算 机 视觉 的 文献 中 均 可 找到 ,包括 参考 文献 
[24.5, 6], 
对 投影 方程 式 (24.7) 对 时 间 求 导 ， 有 


è =X/Z-XZ/Z =(X-xZ)/Z 


(24.7) 


uu 0. (24.8) 

y -Y/Z-YZ/Z -(Y -yZ)/Z 
我 们 可 以 利用 以 下 著名 的 方程 建立 3-D 点 的 速度 和 
摄像 机 空间 速度 之 间 的 关系 


X= -v, -w,Z +%,Y 


X= -v,-w, XXO Y--v 


wX +w, Z 


Z= -v,-0,Y +w, X 
(24.9) 
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将 式 (24.9) 代入 式 (24.8) ， 合 并 同类 项 ， 并 应 用 
式 (24.7), A 


x = —v/Z4+x/Z4+xyw, —(1 ra^ )o, + yo, 
i = -v/ZL+yw/Z+(1 ry )o, xyO, — xa. 
(24. 10) 
可 重 写 为 
x =Ly, (24. 11) 
RP, ZEEE L, 为 
L ee 0 x/Z xy - (lex) "| 
0 -1/Z y/Z 1+y xy x 
(24. 12) 


换言之 ， 存 在 4 个 全 局 最 小 解 ， 并 且 无 法 对 它们 进 
£X AU 。 由 于 这 些 原因 ， 常 常 考 虑 采用 多 于 3 
个 点 。 


24.2.2 交互 矩阵 的 近似 


对 于 构造 用 于 控制 律 的 估计 值 L* ， 有 数 种 方法 
可 供 选 择 。 当 然 ， 如 果 工 , =L, 已 知 ， 即 如 果 每 个 点 


的 当前 深度 是 已 有 的 *， 则 选择 L+ = LS 是 一 种 党 
用 的 方案 。 实 际 上 ， 这 些 参数 必须 在 控制 的 每 次 迁 代 
中 进行 估计 。 基 本 的 IBVS 方法 采用 经 典 的 姿态 估计 
方法 (参见 第 23 章 ，24.3 节 的 开头 部 分 ) 。 另 一 种 


EERE L, P, Z 的 值 是 该 点 相对 于 摄像 机 坐标 系 
的 深度 。 因 此 ， 采 用 如 上 形式 交互 矩阵 的 任何 控 
制 方案 必须 估计 或 近似 给 出 2 的 值 。 类 似 地 ， 在 
计算 x 和 y 时 ,涉及 摄像 机 的 内 参数 。 因 此 ， 在 式 
(24.4) P L? 不 能 直接 使 用 ， 只 能 采用 估计 值 或 


者 近似 值 L* ， 如 式 (24.5) 所 示 。 更 多 细节 将 在 
下 面 讨论 。 

为 了 控制 6 个 自由 度 ， 至 少 3 个 点 是 需要 的 ( 即 
需要 k 宇 6)。 如 果 采 用 特征 矢量 x = (x,，x,，%; )， 
可 以 获得 由 3 个 点 堆砌 成 的 交互 矩阵 

Lı 


在 这 种 情况 下 ， 会 存在 某 些 配置 ， 其 工 , 是 奇异 
Wy"), 而且， 存在 4 种 不 同 摄像 机 姿态 使 得 e =0。 


图 | IRISA/INRIA Rennes vue exterieure 


常用 方法 是 选择 工 ”= 工 . ， 其 中 , L, 是 在 期 望 位 置 


e=e" =0 时 工 , 的 值 2 。 在 这 种 情况 下 ，E:* 是 党 
数 ， 且 每 个 点 只 有 期 望 深度 需要 进行 设 定 ， 这 意味 着 
在 视觉 伺服 过 程 中 必须 估计 无 变化 的 3-D 参数 。 最 
m, 最近 提出 了 采用 Lt = (L./2 + L,/2)* 的 方 
案 *”。 由 于 该 方法 中 涉及 L,， 必 须 获得 每 个 点 的 
当前 深度 。 

我 们 通过 一 个 例子 说 明 这 些 控制 方案 的 行为 。 
目标 为 定位 摄像 机 ， 以 便 其 观测 到 的 矩形 位 于 图 像 
中 心 ( 见 图 24.1)。 我 们 定义 为 形成 矩形 的 4 个 
点 的 x 和 + 坐标 。 注 意 ， 摄 像 机 的 初始 姿态 选 为 远 
离 期 望 姿态 ， 特 别 是 被 认为 对 IBVS 最 成 问题 的 旋 
转运 动 。 在 以 下 给 出 的 仿真 中 ,未 引入 噪声 和 建 
模 误 差 ， 以 便 使 不 同行 为 的 比较 处 于 完全 相同 的 
条 件 下 。 


图 24.1 


定位 任务 的 例子 
a) 相对 于 简单 目标 的 期 望 摄像 机 姿态 b) 初始 摄像 机 姿态 


c) 相应 的 初始 和 期 望 目标 图 像 
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RLS =L;, 获得 的 结果 如 图 24.2 所 示 。 注 意 ， ”摄像 机 坐标 系 中 的 行为 其 至 不 如 L* = LIS 的 情况 。 
不 管 需要 的 偏 移 多 大 ， 系 统 都 收敛 。 但 是 ， 在 图 像 中 ”摄像 机 在 伺服 开始 阶段 速度 大 ,说明 L 在 轨迹 开始 
的 行为 ,或 者 计算 出 的 摄像 机 速度 分 量 ,或 者 摄像 机 ”阶段 条 件数 高 ， 而 且 摄 像 机 的 轨迹 远 非 直线 。 

的 3-D 轨迹 中 ， 都 没有 呈现 出 远离 收敛 位 置 的 期 望 
特性 ( 即 在 开始 阶段 的 30 次 左右 选 代 ) 。 


PERE LS =(L,/2+L,./2)*, 提供 了 好 的 实际 性 


能 。 实 际 上 ， 如 图 24.4 所 示 ， 摄 像 机 的 速度 分 量 未 
AALS =L? 获得 的 结果 如 图 24.3 Br. fedt 含有 大 的 振荡 ， 而 且 在 图 像 空间 和 3-D 空间 的 轨迹 


情况 下 ， 图 像 中 点 的 轨迹 几乎 是 直线 ,但 其 导致 的 在 。 平滑 。 
20 
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a) b) c) 


图 24.2 采用 s = (xi. Yis ox ya) RE; -Lj« 的 系统 行为 
a) 图 像 点 的 轨迹 ， 包 括 抢 形 中 心 点 的 轨迹 ， 该 点 在 控制 方案 中 未 b) 控制 方案 的 每 次 迭代 计算 出 的 六 
分 量 (cm/s 和 deg/s) c) 表示 于 R,, 中 的 摄像 机 光 轴 中 心 的 3-D 轨迹 (cm) 
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a) b) c) 


图 24.3 采用 s = Ge y s as ya) PIE! =L? 的 系统 行为 
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a) b) c) 


图 24.4 采用 s = (x, yi xa ya) PIE? = (L2 «Lo» 2) :的 系统 行为 
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24.2.3 IBVS 的 几何 解释 


对 于 上 述 定义 的 控制 方案 的 行为 ， 很 容易 给 出 几 
何 解 释 。 图 24.5 给 出 的 例子 ， 对 应 于 从 平行 于 图 像 
平面 的 4 个 共 面 点 的 初始 配置 (以 蓝 色 显示 ) 到 期 


望 配置 (以 红色 显示 ) 绕 光 轴 的 纯 旋 转 。 
红色 箭头 代表 控制 方案 中 采用 元 : 时 的 图 像 运动 ， 
蓝 色 箭头 代表 控制 方案 中 采用 LL’ 时 的 图 像 运 动 ， 黑 
色 箭 头 代表 控制 方案 中 采用 (L,/2 € L,, 7/2) 时 的 图 
像 运动 。( 更 多 细节 如 下 ) 
蓝 


蓝 


蓝 
图 24.5 IBVS 的 几何 解释 : 从 蓝 色 位 置 运动 到 红色 位 置 


如 上 述 解 释 ， 在 控制 方案 中 采用 Li 试图 保证 误 
Ze 以 指数 递减 。 这 意味 着 ， 当 x My 图 像 点 坐标 构 
成 误差 时 ， 如 果 可 能 的 话 ， 这 些 点 在 图 像 中 的 轨迹 沿 
着 从 初始 到 期 望 位 置 的 直线 运动 。 这 导致 了 图 24.5 
FP 以 绿 线 表示 的 图 像 运 动 。 实 现 该 图 像 运 动 的 摄像 机 
运动 易于 导出 ， 且 它 确实 由 绕 光 轴 的 旋转 运动 构成 ， 
但 结合 了 一 个 沿 光 轴 的 后 退 平移 运动 "1 。 该 非 期 
望 的 运动 是 由 于 特征 的 选择 ， 以 及 在 交互 矩阵 中 第 3 
列 和 第 6 列 的 耦合 。 如 果 在 初始 和 期 望 配置 之 间 的 旋 
转 很 大 ， 该 现象 将 被 放大 并 导致 一 种 特殊 情况 ， 即 旋 
转 弧度, 但 从 控制 方案 中 不 能 导出 旋转 运动 "1。 
另 一 方面 ， 当 旋转 很 小 时 ， 该 现象 几乎 不 出 现 。 综 上 
所 述 ， 该 行为 是 局 部 令 人 满意 的 〈 即 当 误 差 较 小 
时 ) ， 但 当 误 差 较 大 时 该 行为 不 能 令 人 满意 。 在 后 面 
我 们 将 会 看 到 ， 这 些 结 果 与 IBVS 获得 的 局 部 渐 近 稳 
定 的 结果 是 一 致 的 。 

如 果 在 控制 方案 中 采用 工 ” ， 产 生 的 图 像 运动 如 
图 24.5 中 的 蓝 线 所 示 。 实 际 上 ， 如 果 我 们 考虑 与 前 
面相 同 的 控制 方案 , 但 从 s * 开始 运动 到 s， 则 


Ti 


T 


y, = -àL (s* -s) 
再 次 引起 从 红 点 到 蓝 点 的 直线 运动 轨迹 ， 引 起 棕色 线 
表示 的 图 像 运动 。 回 到 我 们 的 问题 ， 该 控制 方案 计算 
出 的 摄像 机 速度 恰好 相反 
y, = - AL, (s-s^) 
并 且 产 生 的 图 像 运 动 如 图 24. 5 中 红 点 处 的 红线 所 示 。 
在 蓝 点 处 的 变换 ， 摄 像 机 速度 产生 蓝 色 所 示 的 图 像 运 
动 ， 并 再 次 对 应 于 绕 光 轴 的 旋转 运动 ， 以 及 一 个 非 期 
望 的 沿 光 轴 的 前 进 运 动 。 对 于 大 误差 和 小 误差 ， 可 以 
进行 如 前 所 述 的 分 析 。 需 要 补充 说 明 的 是 , 一旦 误差 
明显 下 降 ， 两 种 控制 方案 就 变 得 相近 了 ， 而 且 趋 向 于 
相同 (因为 当 e =e* 时 工 = 工 , ) ， 具 有 如 图 24.5 中 
黑 线 所 示 的 良好 图 像 运动 行为 ， 而 且 当 误差 趋 近 于 0 
时 摄像 机 运动 仅 由 绕 光 轴 的 旋转 构成 。 


如 果 采 用 L* 2(L/2 *L,./2) * , 在 直观 上 很 明 
显 的 是 ， 甚 至 当 误 差 大 时 ,LL, M L., 的 平均 也 产生 如 
图 24.5 中 的 黑 线 所 示 的 图 像 运 动 。 除 旋转 5 弧度 之 
外 ， 在 所 有 的 情况 下 ,摄像机 的 运动 是 绕 光 轴 的 纯 旋 
转运 动 ， 不 含有 任何 非 期 望 的 沿 光 轴 的 平移 运动 。 


24.2.4 稳定 性 分 析 


我 们 现在 考虑 与 IBVS 稳定 性 相关 的 基本 问题 。 
为 了 评价 闭环 视觉 伺服 系统 的 稳定 性 ， 我 们 采用 李 亚 
普 诺 夫 法 分 析 。 特 别 地 ， 考 虑 由 误差 范 数 的 平方 定义 


的 候选 李 亚 普 诺 夫 函数 & -ileo IP, JESPEOS 


R -e'e 
= -AMerT Li. 


e 见 式 (24.6)。 当 下 面 的 充分 条 件 满足 时 ， 可 获得 
系统 的 全 局 渐 近 稳定 性 。 


LL: >0 (24.13) 
如 果 特 征 数量 等 于 摄像 机 自由 度 的 数量 (BD k = 


6) ， 并 且 特 征 的 选择 和 控制 方案 设计 使 得 L MLR 
有 满 秩 6, 而 LS 的 近似 也 不 是 太 粗 糙 ， 则 式 
(24.13) 条 件 能 够 满足 。 

正如 上 面 所 讨论 的 那样 ， 对 于 大 部 分 IBVS 方法 ， 
>6。 因 此 ， 不 能 保证 满足 式 (24.13) 条 件 , LL: < 
民 “*! 的 秩 最 高 为 6， 所 以 L.L:* 具有 非 平凡 的 零 空间 。 
在 此 情况 下 ，e e kerL*: (ker 表示 核 ) 的 配置 对 应 于 
局 部 最 小 。 图 24. 6 给 出 了 达到 这 样 的 局 部 极 小 的 过 
程 。 由 图 24. 6d 可 见 ，e 的 每 个 分 量具 有 相同 收敛 速 
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度 的 指数 下 降 ， 在 图 像 中 产生 的 运动 轨迹 为 直线 ， 但 
其 误差 并 未 真正 到 0。 由 图 24. 6c 可 以 明显 地 看 到 ， 
系统 被 吸引 到 远离 期 望 配置 的 一 个 局 部 极 小 点 。 
此 ，IBVS 仅 具 有 局 部 渐 近 稳定 性 。 

为 了 研究 当 大 >6 时 的 局 部 渐 近 稳定 性 ， 首 先 定 


义 一 个 新 的 误差 e' = 工 + e。 该 误差 的 时 间 导 数 如 下 ， 


^ 


e'=Lié +L le-(LIL «OY, 

式 中 ，OER “5 ， 无 论 如 何 选择 上 ， 当 e=0 时 ，O 
KOPP). RHR (24.5) 控制 方案 ， 则 

ë= - ACE; L, * O)e' 

=0 邻 域内 是 局 部 渐 近 稳定 的 ， 如 果 


(24.14) 


ERE e=e* 
L:L,»0 
sth, DL eR, SRE, necp 


稳定 性 感 兴趣 ， 只 需要 考虑 线性 系统 e' = - AL; 
Le' 13] 


再 者 ， 如 果 特 征 选 择 和 控制 方案 设计 使 得 L, 和 


IRISA/INRIA Rennes vue exterieure 


IRISA/INRIA Rennes vue ex 


L: 具有 满 秩 6， 而 L? 的 近似 也 不 是 太 粗糙 ， 则 式 
(24. 14) 条 件 能 够 满足 。 

结束 讨论 局 部 渐 近 稳定 性 之 前 ， 我 们 必须 指出 ， 
不 存在 任何 配置 ee* ， 使 得 es kerL: 在 e* 的 小 邻 
域内 ， 以 及 在 相应 姿态 p” 的 小 邻 域 内 。 这 种 配置 对 
应 于 局 部 极 小 ， 其 v. =0 且 ee"。 如 果 这 样 一 个 姿 
态 p 存在 ， 则 可 限定 p' 的 邻 域 使 得 存在 从 p BI p* 的 
摄像 机 速度 vy。 该 摄像 机 速度 隐 含 着 误差 的 变化 & = 
Lv, BÆ, ALL, >0， 故 该 变化 不 属于 工 ;* 的 核 。 
因此 ,在 p" 的 小 邻 域内 ， 当 且 仅 当 6 =0 Bleze 
Ay, v, =0。 

我 们 回顾 一 下 ， 当 >6 时 ， 不 能 保证 全 局 渐 近 
稳定 性 ， 但 能 保证 局 部 渐 近 稳定 性 。 例 如 ， 如 图 


24.6 所 示 ， 存 在 对 应 于 配置 e e kerL? 的 很 多 局 部 极 
小 ， 它 们 位 于 上 述 考 虑 的 邻 域 之 外 。 如 何 确 定 能 够 保 
证 稳定 性 和 收敛 的 邻 域 范围 ， 仍 然 是 有 待 解决 的 问 
题 ， 即 使 在 实践 中 该 邻 域 会 非常 大 。 


IRISA/INRIA Rennes vue exterieure 


terieure Ler rl 


d) 


e) 


图 24.6 采用 s = (xis, Yis “ts xg y4) FIL; = Li 达到 局 部 极 小 
a) 初始 配置 b) 期 望 配置 c) 控制 方案 收敛 后 达到 的 配置 d) 控制 方案 每 次 迭代 的 误差 e 的 变化 
e) 摄像 机 速度 w 的 6 个 分 量 的 变化 
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24.2.5 立体 视觉 系统 的 IBVS 


(uu 


IBVS Jrik n] EAECBE" Ré E BEÍSUBL ER B, WS 

采用 立体 视觉 系统 ， 而 且 一 个 三 维 点 在 左右 摄像 机 的 
图 像 中 均 是 可 见 的 ， 则 该 点 可 用 作 视 觉 特 征 
szx,-(x,x,) = (41571 0%, ) 
即 ， 通 过 在 s 中 仅仅 跟踪 观测 点 在 左右 图 像 中 的 * 和 
y 坐标 ， 以 表示 该 点 中。 但 在 构造 相应 的 交互 矩阵 
时 需 注意 ,， 式 (24.11) 给 出 的 表达 式 ， 要么 是 在 左 
摄像 机 坐标 系 ， 要 么 是 在 右 摄像 机 坐标 系 。 更 准确 一 
点 ， 有 


X, -L,v, 
l SL», 
式 中 , v 和 ,分别 是 左右 摄像 机 的 空间 速度 ; 工 , 和 
L, 的 解析 形式 在 式 (24. 12) 给 出 。 
选择 一 个 附着 于 立体 视觉 系统 的 传感器 坐标 系 ， 
则 有 


AF, 5 x, 相关 的 交互 矩阵 可 采用 第 1 章 定 义 的 空 
间 运 动 变换 矩阵 中 确定 ， 它 将 表示 于 左右 摄像 机 坐 
标 系 的 速度 转换 到 传 感 融 坐标 系 。 回 顾 一 下 
R [t],R 

Ca 

AP, [t], WIRE t HCAS AT RE, (R, 06 
SE (3) 是 从 摄像 机 到 传感器 坐标 系 的 刚体 变换 。 该 
和 矩 阵 的 数值 从 立体 视觉 系统 的 标定 直接 获得 。 由 该 方 


程 ， 有 
La 'V, 
L. = n 
CL, V, 


注意 ， 由 于 立体 视觉 系统 中 的 一 个 3-D 点 的 透视 投 
影 构成 极 线 约束 ， 所 以 L、e R*“ 总 是 具有 秩 3 (I 
图 24.7) 。 另 一 种 简单 的 解释 是 ， 一 个 3-D 点 由 3 个 
独立 的 参数 表示 ， 这 就 使 得 采用 任何 传感器 观测 该 点 
时 ， 不 可 能 找 出 多 于 3 个 的 独立 变量 。 

为 了 控制 系统 的 6 个 自由 度 ， 有 必要 考虑 至 少 3 
个 点 ， 因 为 仅 考虑 两 点 时 的 交互 矩阵 的 秩 为 5。 
采用 立体 视觉 系统 时 ， 对 于 在 两 幅 图 像 中 观测 到 
的 任意 点 ， 利 用 简单 的 三 角 法 很 容易 估计 其 3-D As 
标 。 因 此 ,将 这 些 3-D 坐标 用 在 特征 集 s 中 是 可 能 
的 ， 也 是 很 自然 的 。 严 格 地 说 ， 这 种 方法 是 基于 位 置 
的 方法 ， 因 为 在 s 中 需要 3-D 参数 。 


(24.15) 


图 24.7 立体 视觉 系统 


24.2.6 图 像 点 柱 面 坐 标的 IJBVS 
在 前 面 的 小 节 中 ， 我 们 考虑 的 是 图 像 点 的 笛 卡 儿 
E 标 。 正 如 参考 文献 [24.15] 提出 的 ， 用 图 像 点 的 
主 面 坐标 (p, 0) 代替 其 第 卡 儿 坐 标 (x, y), 或许 
是 有 趣 的 。 柱 面 坐 标 如 下 
p= Ji? +y ,0 = arctan 2- 


or ib 


从 而 导出 


p = (xx eyy)/p,0 = (xy -yà )/P 
由 式 (24.11), HH pcos0 代替 *， 用 psing RE y, R 
们 立即 得 到 


-Cc -S p Lam ， 2 
5s Z Z (1 +p°)s (1*p^)c o) 
sto =e o € E 1) 

^ MZ pZ p p 


式 中 ,C=cos0, s=sing, 
在 此 情况 下 获得 的 行为 令 人 相当 满意 。 实 际 上 ， 
考虑 与 前 面相 同 的 例子 ， 且 采用 8 T (o1, 6,, 7, 


p, 6) WIL: =Lt, (HUMOR), ， 其 系统 行为 如 


图 24. 8 所 示 ， 它 具有 与 采用 工 : =(L/24+L,,/2)* 
和 sg=(z y, cs Xa, Ya) 的 系统 行为 同样 好 的 特 
性 。 如 果 我 们 回 到 图 24.5 中 的 例子 ， 得 到 的 行为 也 
将 与 期 望 的 一 样 ， 这 得 益 于 交互 矩阵 第 3 列 和 第 6 列 
的 解 耦 。 


ES 


[a 


24.2.7 其 他 几何 特征 的 IBVS 


在 前 面 的 小 节 中 ， 我 们 仅 考虑 了 s 中 的 图 像 点 。 
其 他 的 几何 原始 特征 ， 当 然 也 可 采用 。 这 样 做 有 几 个 
原因 。 首 先 ， 摄 像 机 观测 的 场景 并 不 总 是 仅仅 由 一 系 
列 的 点 描述 ， 其 图 像 处 理 也 可 提供 其 他 类 型 的 测量 ， 
如 直线 或 者 目标 的 轮廓 。 其 次 ， 丰 富 的 几何 原始 特征 
可 改善 解 耦 和 线性 化 问题 ， 从 而 促进 分 块 系统 的 设 
计 。 最 后 ， 要 实现 的 机 器 人 任务 可 以 以 摄像 机 与 被 观 
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a) b) 


图 24.8 采用 s = (py, 01, 7. pas 01) FIL? =LA 的 系统 行为 


W EL ZT) YY HE ELE FF RE S ez C077, p 
直接 表示 为 原始 特征 之 间 的 约束 ， 如 点 到 线 约 
ROAS (这 意味 着 观测 点 必须 位 于 特定 线 上 )。 
关于 第 一 点 ， 对 于 大 量 几 何 原始 特征 ， 如 片断 、 
直线 、 球 、 圆 、 柱 等 ， 确 定 其 透视 投影 的 交互 矩阵 是 
可 能 的 ， 其 结果 见 参考 文献 [24.1] 和 参考 文献 


式 中 , Ae RES, Be RN. 其 列 来 自 于 摄像 机 的 
一 系列 运动 和 对 应 的 特征 变化 。 当 然 ， 最 小 二 乘法 的 
解 为 

L, -BA* (24. 16) 
基于 神经 网 络 的 方法 也 已 经 被 用 于 估计 LUST, 


直接 估计 出 工 ; 的 数值 解 也 是 可 能 的 ， 这 在 实践 中 能 


[24. 16] 。 近 来 ， 对 应 于 平面 目标 的 任意 图 像 矩 ， 已 
经 可 以 计算 其 交互 矩阵 的 解析 解 。 这 就 使 得 考虑 任意 
形状 的 平面 目标 成 为 可 能 全 2 。 如 果 在 图 像 中 测量 
了 一 系列 点 ， 则 也 可 利用 其 矩 失 2 。 在 两 种 情况 下 ， 
矩 允许 采用 直观 的 几何 特征 ， 如 目标 的 重心 或 者 方 
向 。 通 过 选择 矩 的 适当 组 合 ， 有 可 能 确定 出 具有 良好 
解 耦 和 线性 特性 的 分 块 系统 天 ?2 。 

主意 ， 对 于 所 有 这 些 特征 (几何 原始 特征 ， 
AB), ， 原 始 特征 或 者 目标 的 深度 体现 在 交互 矩阵 中 与 
平移 自由 度 相关 的 系数 上 ， 这 与 图 像 点 的 情况 一 样 。 
对 该 深度 的 估计， 通常 还 是 必要 的 。 也 有 少量 的 例 
外 ， 如 矩 的 适当 标准 化 ， 可 以 允许 在 一 些 特殊 情况 下 
使 得 交互 矩阵 中 仅 有 期 望 的 定常 深度 :21 。 


24.2.8 直接 估计 


在 前 面 的 小 节 中 ， 我 们 将 重点 放 在 了 交互 矩阵 的 
解析 形式 。 也 可 以 采用 离线 学 习 或 者 在 线 估计 方法 ， 
直接 估计 其 数值 解 。 


Fe» 


提供 更 好 的 行为 。 在 此 情况 下 ， 基 本 关系 为 


L; As = Av, 
上 式 提 供 了 6 个 方程 。 利 用 和 N 次 测量 ,，N >k， 则 有 
L* =AB* (24.17) 


在 式 (24.16) 的 第 一 种 情况 下 , L, 的 6 列 通 过 求解 
6 个 线性 系统 进行 估计 。 而 在 式 (24. 17) 的 第 二 种 
TROL, LS 的 记 列 通过 求解 个 线性 系统 进行 估计 。 
这 就 是 上 述 结果 中 的 差别 。 

在 线 佑 计 交 互 矩阵 可 以 看 作 优化 问题 ， 许 多 研究 
者 已 经 研究 了 一 些 源 自 优化 的 方法 。 这 些 方法 将 系统 
方程 (24.2) 进行 离散 化 ， 并 在 每 个 阶段 采用 迭代 


更 新 方案 优化 工 的 估计 。 参 考 文献 [24.24, 25] 给 
出 的 一 种 采用 希 罗 伊 登 (Broyden) 更 新 规则 的 在 线 
BRAR: 


L1) =L.(1) + 


Q 


Av! Ay, 


[ Ax - L, (t) Av, ] Av? 


已 提出 的 数值 估计 交互 矩阵 的 所 有 方法 ， 依 赖 于 
对 已 知 的 或 测量 的 摄像 机 运动 所 引起 的 特征 变化 的 观 
测 。 更 准确 地 说 ， 如 果 由 于 摄像 机 的 运动 Ar.， 我 们 
测量 到 的 一 个 特征 的 变化 为 As， 则 由 式 (24.2) 有 
LAv.=As 
ERHET k ADE, ME L, PA k x 6 个 未 知 数 。 
利用 NN 次 独立 的 摄像 机 运动 ，N >6， 则 可 以 通过 求 
解 下 式 估 计 出 工 , 


LA=B 


AF, a 定义 了 更 新 速度 。 在 参考 文献 [24.26] 中 ， 
该 方法 已 推广 到 运动 目标 的 情况 。 

在 控制 方案 中 采用 数值 估计 的 主要 优点 是 ， 
避免 了 所 有 的 建 模 和 标定 步骤 。 当 所 采用 特征 的 
交互 矩阵 不 能 得 到 解析 解 时 ， 数 值 估计 特别 有 用 。 
例如 ， 在 参考 文献 [24.27] 中 ， 一 幅 图 像 的 主 成 
分 分 析 的 主 特征 值 ， 被 用 于 视觉 伺服 方案 。 这 些 
方法 的 缺点 是 ， 不 能 从 理论 上 进行 稳定 性 和 重 棒 
性 分 析 。 
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24.3 ”基于 位 置 的 视觉 伺服 


基于 位 置 的 控制 方案 ”采用 摄像 机 相对 
于 某 参 考 坐标 系 的 位 姿 定义 s。 从 一 幅 图 像 的 一 系 
列 测量 值 中 计算 位 姿 , 需要 已 知 摄像 机 的 内 参数 
和 被 观测 目标 的 3-D 模型 。 这 一 经 典 的 计算 机 视 
觉 问 题 称 为 3-D 定位 问题 。 该 问题 超出 本 章 的 讨 
论 范围 ， 但 在 参考 文献 [24.30, 31] 中 可 以 找到 
很 多 解决 方法 ， 其 基本 原理 在 第 23 章 进 行 了 
回顾 。 

典型 地 ， 以 代表 摄像 机 位 姿 的 参数 形式 定义 so 
TER, s 的 定义 式 (24.1) 中 的 参数 a， 现 在 是 摄像 
机 的 内 参数 和 目标 的 3-D 模型 。 

为 方便 起 见 ， 考 虑 3 个 坐标 系 : 当前 摄像 机 坐标 
系 FZ.， 期 望 摄像 机 坐标 系 .FF., ， 以 及 附着 于 目标 的 
参考 坐标 系 .多 . 。 此 处 ， 采 用 首位 上 标 符号 代表 一 系 
列 坐标 所 处 的 坐标 系 。 于 是 ， 坐 标 矢 量 “ 和 *t,， 分 
别 代表 在 当前 摄像 机 坐标 系 和 期 望 摄像 机 坐标 系 下 ， 
目标 坐标 系 原点 的 坐标 。 此 外 ， 以 R =°" R, 作为 旋 
转 和 矩阵 ， 表 示 当 前 摄像 机 坐标 系 相 对 于 期 望 摄像 机 坐 
标 系 的 姿态 。 

将 8 定义 为 (t, 经 ) ， 其 中 ,上 为 平移 矢量 ，bz 
为 旋转 的 角 / 轴 参数 。 现 在 讨论 上 的 两 种 选择 ， 并 给 
出 相应 的 控制 律 。 

如 果 上 相对 于 目标 坐标 系 .多 .定义 ， 则 有 sg CO, 
0), Rle-('t, "^ t,, 0u), 在 此 


Qu), s* = (t, 


情况 下 ， 关 于 e 的 交互 矩阵 为 


-L ['t]. 
L,- 
0 La 


(24.18) 


a) b) 


(24. 19) 
st, sinc x 为 正弦 基 ， 其 定义 为 x sine x = sin x H 
sinc 0=1, 
根据 24. 1 节 ， 我 们 得 到 控制 方案 
y,- ie 
式 中 , s 的 维 数 开 为 6， 即 摄像 机 自由 度 的 数量 。 


设 定 


: | (24. 20) 


t [^t,] ,Ou 


人 ae hae aa ] (24.21) 


R, = - Au 
ste, La PEE Li bu = Ou. 

理想 情况 下 ， 如 果 姿 态 参数 估计 准确 ， 则 e 的 行 
为 将 为 期 望 行为 (e = - Ae)。e 的 选择 会 引起 跟随 
测 地 线 的 旋转 运动 以 指数 速度 下 降 ， 会 引起 s 中 的 平 
移 参 数 以 同样 速度 下 降 。 这 就 解释 了 为 什么 图 24.9 
中 的 摄像 机 速度 分 量 以 良好 的 指数 规律 下 降 。 此 外 ， 
目标 坐标 系 原点 在 图 像 中 的 轨迹 为 一 条 直线 (此 处 
选择 4 个 点 的 中 心 为 原点 )。 男 一 方面 ， 摄 像 机 的 轨 
迹 不 是 沿 着 一 条 直线 。 

另 一 种 PBVS 方案 采用 s = ("*t.，0u) 设计 。 Æ 
此 情况 下 , s* =0, e=s, H 


R 0 
L,= 
0 Ly 


注意 到 平移 与 旋转 运动 的 解 厢 ， 这 允许 我 们 获得 简单 
的 控制 方案 


20 
0 
-20 a M 
-20 Ü 20 
20 *0 


(24.22) 


图 24.9 采用 s = (Ct,, ou) 的 系统 行为 
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u€— 79) 而 图 像 轨迹 则 不 如 以 前 令 人 满意 。 甚 至 可 以 发 现 某 些 


在 此 情况 下 ， 如 图 24. 10 所 示 ， 如 果 式 (24.23) 中 


0 25 50 


b) 


a) 


特殊 的 配置 ， 使 得 某 些 点 离开 摄像 机 的 视 场 。 


20 
0 
20 72 
-20 Ü 20 
20 “0 
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图 24. 10 采用 s = (°t., Ou) 的 系统 行为 


PBVS 的 稳定 性 特性 看 起 来 很 具有 吸引 力 。 因 为 
当 0 关 2km 时 ， 式 (24.19). 给 出 的 工 ,是 非 奇 异 的 ， 


在 所 有 姿态 参数 是 准确 的 这 一 强 假设 下 ,L,L-' =1,， 
所 以 由 式 (24. 13) 可 以 获得 系统 的 全 局 渐 近 稳定 。 
这 对 上 述 两 种 方法 均 成 立 ， 因 为 当 工 , 非 奇异 时 ， 式 
(24.18) 和 式 (24.22) 给 出 的 交互 矩阵 是 满 秩 的 。 
关于 和 鲁 棒 性 ， 反 馈 是 采用 估计 量 计算 的 ， 而 估计 
量 是 图 像 测 量 和 系统 标定 参数 的 函数 。 对 于 24. 3 节 中 
的 第 一 种 方法 (第 二 种 方法 的 分 析 类 似 )， 式 (24. 18) 


IRISA/INRIA Rennes vue exterieure 


a) 
图 24.11 两 种 不 同 的 摄像 机 姿态 ，a) 和 c ) 提供 4 个 共 面 点 b) 的 几乎 相同 的 图 像 


D) 


24.4 先进 方法 


24.4.1 混合 视觉 伺服 


假设 我 们 已 获得 o, 的 很 好 的 控制 律 ， 例 如 在 


给 出 的 交互 矩阵 对 应 于 准确 估计 的 姿态 参数 ， 而 估计 
的 姿态 参数 可 能 由 于 标定 误差 而 偏离 真实 值 ， 或 者 由 
于 噪声 而 不 精确 或 不 稳定 ， 所 以 真实 值 是 未 知 
Ay RERE, EDEN IE AS TEILS ON 


LL; >0 (24. 24) 
sth, Lr Ha (24.20) 给 出 , 但 LRA, ERRE 
HixX (24.18) 给 出 。 实 际 上 ， 在 图 像 中 计算 出 的 点 


的 位 置 即使 存在 很 小 的 误差 ， 也 会 导致 姿态 误差 ， 明 
显影 响 系 统 的 精度 和 稳定 性 〈 见 图 24. 11) 。 


MS 


IRISA/INRIA Rennes vue exterieure 


c) 


PBVS 中 使 用 的 控制 律 ， 见 式 (24.21) 或 式 (24.23): 
(24.25) 


@, = -Àu 
我 们 如 何 将 其 与 传统 的 IBVS 结合 使 用 ? 
考虑 用 于 控制 平移 自由 度 的 特征 矢量 s, 和 误差 
e,， 我 们 可 以 将 交互 矩阵 分 块 如 下 : 
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Y, 
s,=L,v,=(L, L,) | Jes +L,o, 
Qo. 


现在 ， 设 定 e, = -Ae, MVR AE AF RE Tn 
输入 为 


= 


—he,=e,=8,=L,v,+L,o, 
=v, = -Lý (Ae, +L,@.) (24.26) 
我 们 可 以 将 (Ae, -L,o,) 作为 误差 修正 项 ， 它 
结合 了 原始 误差 和 由 旋转 运动 w. 引起 的 误差 。 平移 
控制 输入 mw = —L/(Ae, +L.) 将 使 该 误差 趋 近 于 
0。 该 方法 称 为 2.5-D 视觉 伺服 '*” ， 首 次 探索 了 结 
合 IBVS 和 PBVS 的 一 种 分 块 。 更 确切 地 说 ， 在 参考 
文献 [24.32] "P, s, 选取 图 像 点 的 坐标 及 其 深度 的 
TR, ORE, L, 是 一 个 可 逆 的 三 角 和 矩阵 。 更 确切 地 
说 ， 我 们 有 s,=(x, logZ), sf 2(x', logZ'), e = 
(x-x', logpz), Ht pz=Z/Z*, H 


-1 0 X 

Leno -i y 
yA 

2 0 0 -1 


xy -(1-x) y 
L,- 1«y Xy x 
-y 0 


注意 ， 比 率 pz 能 够 从 局 部 姿态 估计 算法 中 直接 获得 ， 
相关 算法 将 在 24. 6 INA. 

如 果 我 们 回 到 视觉 伺服 方案 的 常用 全 局 表示 ， 则 
Ae=(e,, 0u), L, 为 


pen 
L, = 
0 Li 
应 用 式 (24.5), ， 可 以 立即 从 上 式 得 到 控制 规律 式 
(24.25) 和 式 (24.26), 

采用 上 述 s, 获得 的 行为 如 图 24. 12 所 示 。 此 处 ， 
s, 中 的 点 为 目标 的 重心 x,。 我 们 注意 到 ， 该 点 的 图 像 
轨迹 正如 期 望 的 那样 ， 是 一 条 直线 ， 而 且 摄像 机 的 速 


0 25 50 
a) b) 


图 24. 12 RAs = (x,, log (Z,) , Ou) 的 系统 行为 


度 分 量 下 降 良好 ， 这 使 得 该 方案 非常 接近 PBVS 的 第 
一 种 方案 。 

关于 稳定 性 ， 很 明显 该 方案 在 理想 的 条 件 下 是 全 
局 渐 近 稳定 的 。 此 外 ， 得 益 于 交互 矩阵 元 的 三 角形 
式 ， 采 用 24. 6 节 介 绍 的 局 部 姿态 估计 算法 1， 能 
够 分 析 该 方案 在 存在 标定 误差 时 的 稳定 性 。 最 后 ， 访 
方案 中 唯一 未 知 的 定常 参数 Z* ， 可 以 采用 自 适应 技 
RER, 

也 可 以 设计 其 他 的 混合 方案 。 例 如 ， 在 参考 文献 
[24.35] P, s, 的 第 三 个 元 素 是 不 同 的 ， 其 选择 使 得 
所 有 目标 点 尽 可 能 保留 在 摄像 机 的 视 场 中 。 参 考 文献 
[24.36] 给 出 了 另 一 个 例子 。 在 该 例 中 ,s 选 作 s = 
(“t,x。，0u,)， 以 提供 如 下 形式 的 分 块 三 角 交 互 


和 矩阵: 

< 人 0 

“(by La 
RP, LIM L RADIA, LPIA PR, X 
方案 的 行为 如 下 : 摄像 机 的 轨迹 是 一 条 直线 (A 
为 ““t. 是 s 的 一 部 分 )， 目标 重 心 的 图 像 轨 迹 也 是 
一 条 直线 (因为 x, 也 是 s 的 一 部 分 )。 平 移 摄 像 机 
自由 度 用 于 实现 3-D 直线 ， 而 旋转 摄像 机 自由 度 
用 于 实现 2-D 直线 ， 并 补偿 由 于 平移 运动 引起 的 
x, 的 2-D 运动 。 如 图 24.13 所 示 ， 该 方案 实际 上 
相当 令 人 满意 。 

最 后 ， 以 不 同 的 方法 结合 2-D 和 3-D 是 可 能 
的 。 例 如 ， 在 参考 文献 [24.37] 中 ， 提 出 了 在 s 中 
采用 一 系列 图 像 点 的 2-D 齐 次 像素 坐标 乘 以 对 应 的 
TRE: s = (u,Z,, vZ, Z,.,ce. u,Z,, v,Z,, 
Z,)。 对 于 经 典 的 IBVS， 在 此 情况 下 我 们 获得 一 系 
列 元 余 特 征 ， 因 为 至 少 需 要 三 个 点 以 控制 摄像 机 的 
6 个 自由 度 (此 处 三 9)。 然 而 , 在 参考 文献 
[24.38] POURS, 选择 匈 余 特 征 与 有 吸引 力 的 局 
部 极 小 没有 关系 。 
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a) b) 


图 24.13 采用 s = (7 


24. 4.2 ”分 块 视觉 伺服 


上 面 介绍 的 混合 视觉 伺服 方案 ， 通 过 选择 适当 的 
视觉 特征 ， 部 分 为 2-D， 部 分 为 3-D (这 也 是 它们 为 
何 被 称 为 2.5-D 视觉 伺服 的 原因 ) ， 将 旋转 运动 从 平 
移 运动 中 解 耦 出 来 。 该 工作 激发 了 一 些 研 究 者 ， 去 寻 
找 能 够 展现 出 类 似 解 耦 特 性 的 特征 ， 但 采用 仅仅 直接 
表达 于 图 像 中 的 特征 。 更 确切 地 说 ， 该 目标 是 寻找 6 
个 特征 ， 每 个 特征 只 与 一 个 自由 度 相关 (在 此 情况 
下 ,交互 矩阵 是 对 角 和 矩阵 ) 。 最 高 目标 是 寻找 一 个 元 
素 为 常数 的 对 角 交 互 矩阵 ， 并 尽 可 能 接近 单位 矩阵 ， 
从 而 导致 一 个 纯粹 的 、 直 接 的 、 简 单 的 线性 控制 
问题 。 

在 该 领域 中 的 第 一 项 工作 是 将 交互 矩阵 分 块 ， 以 
隔离 与 光 轴 相关 的 运动 党 52。 实际 上 ， 无 论 如 何 选 
s, 我 们 有 

s =Ly,=L,y,, +L.v,=s, +8, 

式 中 , LERT L 的 第 一 、 第 二 、 第 四 和 第 五 列 ; 
LBRT L, 的 第 三 和 第 六 列 。 类 似 地 ，w = (v, 
v,, Q,, @,), V, 2 (v,, @,). IKAR, s, = 工 .7 给 出 的 
是 由 于 摄像 机 沿 着 和 绕 着 光 轴 运动 产生 的 8 的 分 量 ， 
S ,= 工 ,v, 给 出 的 是 由 于 沿 着 和 绕 着 摄像 机 的 x 和 y 
轴 运 动产 生 的 8 的 分 量 。 

WEE, WE e = -Ae， 


则 有 
-Ae=e cs =L v, * Ly, 
从 而 有 
v, = - Li [Ae(1) +Lv.] 
与 前 面 一 样 ， 我 们 可 将 [Ae(1) +L.v.] 看 作 修 正 误差 ， 
它 结 合 了 原始 误差 和 由 v, 引起 的 误差 。 
给 出 该 结果 后 ， 剩 下 的 问题 就 是 选择 * 和 v.。 与 
基本 的 IBVS 一 样 ， 一 系列 图 像 点 的 坐标 可 用 于 so 


xas OU, ) 的 系统 行为 


同时 ,定义 了 两 个 新 的 图 像 特征 以 确定 y.。 

1) 定义 a 为 图 像 平面 的 水 平 轴 与 连接 两 个 特征 
点 的 线段 之 间 的 夹 角 ,，0 大 wa <27。 显 然 ,，a 与 绕 光 
轴 的 旋转 密切 相关 。 

2) 定义 o 为 这 些 点 构成 的 多 边 形 的 面积 。 类 
似 地 ，e 与 沿 光 轴 的 平移 密切 相关 。 

采用 这 些 特征 ，v. 在 参考 文献 [24.10] 被 定 
义 为 


24.5 性 能 优化 与 规划 


在 某 种 意义 上 ， 分 块 方法 表现 了 对 优化 系统 性 能 
的 一 种 努力 ， 该 方法 通过 将 独 有 的 特征 和 控制 器 配置 
到 各 个 自由 度 实现 优化 。 这 样 ， 在 将 控制 器 分 配 到 所 
由 度 时 ,设计 者 需要 完成 一 种 离线 优化 。 明 确 地 设计 
控制 器 以 优化 各 种 系统 性 能 ， 也 是 可 能 的 。 我 们 在 本 
节 中 介绍 几 种 这 类 方法 。 


24.5.1 优化 控制 与 元 余 框 架 


这 种 方法 的 一 个 例子 见 参 考 文献 [24. 39] 和 参 
考 文献 [24.40] ， 其 中 线性 二 次 高 共 
ic Gaussian, LQG) 控制 设计 用 于 选择 最 小 化 状态 与 
输入 线性 组 合 的 增益 。 该 方法 直接 平衡 了 跟踪 误差 
(因为 控制 器 试图 使 s-s* 为 0) 和 机 器 人 运动 之 间 
的 交替 关系 。 在 参考 文献 [24.41] 中 提出 了 一 种 类 
似 的 方法 ， 那 就 是 在 定位 任务 中 同时 考虑 避免 关节 
限 位 。 

也 可 以 规定 最 优 性 判 据 ， 以 明确 表示 机 器 人 的 
运动 在 图 像 中 的 观测 值 。 例 如 ， 交 互 和 矩阵 的 奇异 值 
分 解 给 出 了 哪些 自由 度 是 最 明显 的 ， 从 而 也 是 最 容 


ft (linear quadrat- 
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易 控 制 的 ; 交互 矩阵 的 条 件数 给 出 了 运动 可 视 性 的 

种 全 局 测量 。 该 概念 在 参考 文献 [24.42] 中 称 
为 可 解 性 ， 在 参考 文献 [24.43] 中 称 为 可 感知 性 。 
通过 选择 特征 并 设计 控制 器 ,使 针对 某 些 特定 的 自 
由 度 或 者 全 局 的 这 些 测量 最 大 化 ， 可 以 改善 视觉 伺 
服 系统 的 性 能 。 


Bm. X 


PBVS 各 自 的 不 足 。 


图 24. 14 给 出 了 一 个 绕 光 轴 旋 转 160° 的 此 类 系统 


是 ， 随 着 摄像 机 的 后 退 ， 


采用 优化 控制 方法 设计 控制 方案 所 考虑 的 约束 ， 
在 某 些 情况 下 可 能 是 相反 的 ， 由 于 在 被 最 小 化 的 目 
标 函 数 中 的 局 部 极 小 ， 会 导致 系统 失败 。 例 如 ， 可 
能 会 发 生 这 样 的 情况 ， 从 机 器 人 关节 限 位 离开 的 运 
动 恰好 与 趋 近 目标 位 姿 的 运动 相反 ， 从 而 导致 一 
个 零 全 局 运动 。 为 了 避免 这 一 潜在 问题 ， 可 以 采 
用 梯度 投影 法 ， 这 在 机 器 人 学 中 是 经 典 的 。 在 参 
考 文献 [24.1] 和 [24.17] 中 , 已 经 将 该 方法 
用 于 视觉 何 服 。 该 方法 将 次 要 约束 投影 到 基于 
视觉 的 任务 e 的 零 空间 ， 从 而 它们 对 于 e 到 0 的 调 
节 没 有 影响 。 


e, si? e+P.e, 
RP, e, 是 要 考虑 的 全 局 新 任务 ; 已 =U, -Li L,) 


[Ef E Pe =0，VYe 。 在 参考 文献 [24.44] 中 , X 
用 该 方法 避免 机 器 人 关节 的 限 位 。 然 而 ， 当 基于 视觉 
的 任务 约束 摄像 机 的 所 有 自由 度 时 ， 不 能 考虑 次 要 约 


束 ， 因 为 当 工 具有 满 秩 6 时 ， 有 Pe =0，Ve 。 在 
此 情况 下 ， 有 必要 在 全 局 目标 函数 如 导航 函数 中 加 入 
AR, DAE REGE e s pp] eem 


24.5.0 ”开关 方案 


前 面 描述 的 分 块 方法 ， 试 图 通过 将 独立 的 控制 器 
配置 到 特定 的 自由 度 以 优化 性 能 。 另 一 种 方法 是 采用 
多 控制 器 以 优化 性 能 ， 即 设计 开关 方案 ,在任 一 时 刻 
基于 优化 判 据 选用 相应 的 控制 器 。 

一 种 简单 的 开关 控制 器 ， 可 以 采用 IBVS fil PBVS 
控制 器 来 设计 '*”1。 对 于 PBVS 控制 器 ， 考 虑 其 李 亚 


诺 夫 函数 多 -3 lec IF, REB e(t) = Ct, - 
0u)., 。 如 果 在 任意 时 刻 李 亚 善 诺 夫 函数 的 值 超过 阔 值 


ER, ASIC IBVS 模式 开始 ， 其 图 像 


特征 开始 以 指向 图 像 中 目标 位 置 的 直线 方向 运动 。 但 
该 系统 切换 到 PBVS， 人 允许 
像 机 结合 绕 光 轴 的 旋转 运动 和 向 前 的 平移 运动 到 达 
其 期 望 位 置 ， 在 图 像 中 产生 圆 缴 轨迹。 


0 50 100 150 200 250 300 350 400 450 500 


图 24. 14 采用 开关 控制 方案 绕 光 轴 旋转 160° 的 图 像 
特征 轨迹 (初始 点 位 置 为 蓝 色 ， 期望 点 位 置 为 红色 ) 


还 有 其 他 一 些 时 间 开 关 方 案 的 例子 ， 以 保证 被 观 


, XS NR RU GE fü 


yp， 则 系统 切换 到 PBVS Feil 48. 458 PBVS 控制 
器 时 ， 在 任意 时 刻 李 亚 普 诺 夫 函 数 的 值 超 过 阔 值 & = 


Flee) 让 > 六 ， 则 系统 切换 到 IBVS 控制 器 。 采 用 
te eine 
— BUA, AIA, A FARE 

TAK AAA, WRF A REEE, ipm 
能 够 利用 IBVS 和 PBVS 各 自 的 优势 ， 并 避免 IBVS 和 


RÆ s-s 较 大 时 ， 建 


测 目 标的 可 见 性 ， 例 如 参考 文献 [24.48] 中 的 
方案 。 


24.5.3 ”特征 轨迹 规划 


也 可 以 在 规划 阶段 ， 
此 人情 
par [24.49] 
性 524.501 。 
姿 的 特征 轨迹 s* (t), 
例如 众所周知 的 势 场 法 。 
路 径 规划 与 轨迹 跟踪 的 


离线 处 理 优化 问题 。 在 
况 下 ,可 以 同时 考虑 几 个 约束 ,例如 如 
É, fe UE A ty ay Fy A 
保证 满足 约束 并 允许 摄像 机 到 达 期 望 位 
可 采用 路 径 规 划 技 术 确 定 ， 


结合 ， 使 得 视觉 伺服 对 
于 建 模 误差 的 鲁 棒 性 得 到 极 大 的 改善 。 事 实 上 ， 当 
LE 模 误差 会 有 很 大 影响 ， 当 误差 
s—s 较 小 时 ， 建 模 误 差 的 影响 较 小 。 一 旦 符合 s* (0) 


=s(0) 的 期 望 特征 轨迹 8 (t) 在 规划 阶段 完成 设 


i, EZES st 是 变化 的 ， 并 
小 的 情况 下 ， 很 容易 修改 控 
们 有 


e-zs-s^ 


使 误差 gs -保持 较 


制 方案 。 更 确切 地 说 ， 我 


=Lv.—s 
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通过 选择 常用 期 望 行为 5 = - Ahe， 由 上 式 可 以 扒 
导出 ， 


y, = Be dar es Oe i 
该 控制 律 新 的 第 二 项 引入 了 期 望 值 s* 的 变化 率 ， 
以 消除 由 其 引起 的 跟踪 误差 。 在 24.7 节 我 们 将 会 
看 到 ， 当 跟踪 运动 目标 时 ， 其 控制 律 的 形式 是 相 
似 的 。 


24.6 3-D 参数 估计 


上 面 介绍 的 所 有 控制 方案 都 用 到 3-D 参数 ， 而 
3-D 参数 在 视觉 测量 中 不 是 直接 可 用 的 。 我 们 简要 
回顾 一 下 ， 对 于 IBVS， 目 标 相对 于 摄像 机 的 范围 体 
现在 交互 矩阵 与 平移 自由 度 相关 的 系数 中 。 值 得 注 
意 的 是 ， 基 于 数值 估计 工 , 或 Li; 的 方案 是 个 例外 
(参见 24.2.8 节 ) 。 另 一 个 例外 是 采用 常数 矩阵 的 
IBVS 方案 ， 它 仅 需 要 期 望 位 姿 的 深度 ， 而 该 深度 在 
实践 中 不 难 获得 。 对 于 PBVS 和 在 e 中 结合 2-D 与 
3-D 数据 的 混合 方案 ，3-D 参数 既 出 现在 要 调整 到 
0 的 误差 e 中 ， 又 出 现在 交互 矩阵 中 。 涉 及 3-D 参 
数 的 正确 估计 ， 对 于 IBVS 非常 重要 ， 因 为 它们 对 
摄像 机 在 任务 执行 过 程 中 的 运动 具有 影响 (它们 
体现 在 稳定 条 件 式 (24.13) 和 式 (24.14) 中 )。 
3-D 参数 的 正确 估计 ， 对 于 PBVS 和 混合 方案 是 至 
关 重 要 的 ， 因 为 它们 对 于 收敛 后 达到 的 位 姿 具 有 
影响 。 

如 果 采 用 一 个 已 经 标定 过 的 立体 视觉 系统 ， 则 所 
有 的 3-D 参数 可 以 很 容易 地 利用 三 角 测 量 法 获得 ， 
参见 24. 2.5 节 和 第 23 章 。 类 似 地 ， 如 果 目 标的 3-D 
模型 已 知 ， 则 所 有 的 3-D 参数 可 以 从 位 姿 估 计算 法 
中 计算 出 来 。 但 是 ， 这 样 的 估计 可 能 由 于 图 像 噪声 而 
很 不 稳定 。 极 线 几 何 与 不 同 视点 观测 相同 场景 的 图 像 
相关 ， 利 用 极 线 几何 也 可 以 估计 3-D 参数 。 事 实 上 ， 
在 视觉 伺服 中 ， 有 两 幅 图 像 常 常 是 可 用 的 : 当前 图 像 
和 期 望 图 像 。 

给 定 在 当前 图 像 和 期 望 图 像 中 的 图 像 测量 的 一 
系列 匹配 ， 如 果 摄 像 机 已 经 进行 了 标定 ， 则 基本 和 矩 
阵 或 者 本 质 和 矩阵 可 以 计算 出 来 中， 进而 用 于 视觉 
Jag Uto 。 实 际 上 ， 从 本 质 和 矩阵 中 ， 可 以 估计 出 带 
比例 因子 的 旋转 矩阵 和 平移 矢量 。 但 是 ， 在 接近 视 
觉 伺服 收敛 点 时 ， 即 在 当前 图 像 和 期 望 图 像 很 相似 
时 ， 极 线 几 何 变 成 退化 的 ， 不 能 准确 估计 两 个 视点 
之 间 的 位 姿 偏差 。 由 于 这 一 原因 ， 采 用 单 应 性 更 受 


青睐 。 


=] ud 


VÀ x; 和 x? 分别 代表 一 个 点 在 当前 图 像 和 期 望 图 
像 中 的 齐 次 图 像 坐标 。x; 和 x; 的 关系 表示 为 
x, = 再 ix 
IP, H, 为 单 应 性 矩阵 。 

如 果 所 有 的 特征 点 在 一 个 3-D 平面 内 ， 则 存在 
一 个 单 应 性 矩阵 H, [E153 x, = Hx; 对 所 有 的 i 成 立 。 
该 单 应 性 可 采用 期 望 图 像 和 当前 图 像 中 的 4 个 匹配 点 
的 位 置 进行 估计 。 如 果 不 是 所 有 的 特征 点 都 属于 同一 
个 3-D 平 面 ， 则 可 利用 3 个 点 定义 一 个 这 样 的 平面 ， 
需要 5 个 附加 点 来 估计 HOS, 

一 且 获 得 囊 ， 则 可 将 其 分 解 为 


H=R++n"" 


(24.27) 


式 中 ,，R 是 与 当前 和 期 望 摄 像 机 坐标 系 的 姿态 相关 的 
旋转 矩阵 ; n^ 是 选择 的 3-D 平面 在 期 望 坐标 系 中 的 
法 向 量 ; d^ 是 期 望 坐标 系 到 3-DD 平 面 的 距离 ; t 是 当 
前 和 期 望 坐标 系 之 间 的 平移 。 从 五 中 ， 有 可 能 恢复 
HR. Ud' 和 n*。 事实 上 , 这 些 变 量 存在 两 组 
解 .* 引 I， 但 利用 期 望 位 姿 的 某 些 知识 很 容易 选择 出 
正确 解 。 也 可 以 估计 出 任意 目标 点 带 有 公共 比例 因子 
MOREL 在 经 典 的 IBVS 中 每 个 点 的 未 知 深度 ， 
可 以 表示 为 单一 常数 的 函数 。 类 似 地 ，PBVS 需要 的 
位 姿 参 数 也 可 以 恢复 ,但 在 其 平移 项 中 带 有 比例 因 
子 。 因 此 ， 前 述 PBVS 方案 可 以 采用 这 种 方法 ， 将 其 
新 的 误差 定义 为 带 比例 因子 的 平移 误差 和 旋转 的 角 / 
轴 参 数 化 误差 。 最 后 ， 该 方法 已 用 于 24.4.1 节 介 绍 
的 混合 视觉 伺服 方案 。 在 此 情况 下 ， 采 用 这 种 单 应 性 
估计 ， 有 望 分 析 混合 视觉 伺服 方案 在 存在 标定 误差 时 
REE 。 


24.7 目标 跟踪 


现在 ， 我 们 考虑 运动 目标 的 情况 。 此 时 ， 固 定 的 
期 望 特征 值 s* 被 汉化 为 变化 的 期 望 特征 s* (1)。 其 
误差 的 时 间 变 化 为 


e =L ee 

^* Ot 

SU, de/at 项 表示 由 于 未 知 的 目标 运动 引起 的 e 的 
时 变 。 如 果 控 制 律 仍然 设计 为 试图 保证 e 的 指数 解 耦 


PRE (e = -Ae)， 则 由 式 (24.28) 有 


(24. 28) 


^ 


T -aLi e -Li (24. 29) 


式 中 ，9e/9t 是 e/t 的 估计 或 近似 。 该 项 必需 引入 
控制 律 ， 以 补偿 目标 的 运动 。 
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将 回路 闭环 ， 即 将 式 (24.29) FLASK (24.28) , 
有 


é= -AL Lie- LL: .0 

ot ot 

EMELE? >0， 也 只 有 当 96/61 的 估计 值 充 分 准确 到 

使 式 (24.31) 成 立时 ,误差 才 收 敛 到 0。 
工人 8 -8 

"^ Ot at 

否则 , 会 有 跟踪 误差 。 实际 上 , 仪 通过 求解 式 

(24.30) 化 简 后 的 标量 微分 方程 e = -Ae+5， 可 以 

BRAG e(t) =e(0)exp( — M) +b/A, KAF b/N, 一 方 

面 ， 设 定 高 的 增益 入 MARR RIZE, [H$3— 7 h 


(24. 30) 


(24.31) 


分 量 作为 机 器 人 控制 器 的 输入 。 一 旦 机 器 人 不 能 实现 
该 运动 ， 例 如 ， 因 为 机 器 人 少 于 6 个 自由 度 ， 则 控制 
方案 必须 在 关节 空间 中 表示 。 本 节 中 ， 我 们 将 介绍 如 
何 实现 上 述 控制 ， 并 在 此 过 程 中 导出 Eye-to- Hand 系 
统 的 公式 。 

在 关节 空间 中 ，Eye-to- Hand 和 Eye-in- Hand 配 
置 的 系统 方程 具有 相同 形式 : 


(24. 32) 


xh, J, eR “是 特征 雅 可 比 和 矩阵， 可 以 建立 与 交 
互 矩 阵 之 间 的 联系 , ”是 机 器 人 的 关节 数量 。 
对 于 Eye-in-Hand 系统 (ILE 24. 15a) , as/at 


| 
增益 太 高 会 导致 系统 不 稳定 。 因 此 ,需要 使 6 uj 
能 小 。 
当然 ， 如 果 已 知 系 统 9e/9t =0 ( 即 摄像 机 观测 不 
运动 的 目标 ， 见 24. 1 节 ) ， 则 采用 9e/9t = 0 给 出 的 
最 简单 的 估计 也 不 会 出 现 跟 踪 误 差 。 否 则 ， 可 采用 自 
动 控制 中 消除 跟踪 误差 的 经 典 方法 ， 即 通过 在 控制 律 
中 的 积分 项 补偿 目标 的 运动 。 在 此 情况 下 ， 有 


^ 


oe. p > ej) 

式 中 , 人 是 积分 增益 ， 必 需 被 调整 。 只 有 当 目 标 以 恒 
速 运动 时 ， 该 方案 才能 消除 跟踪 误差 。 其 他 方法 ， 例 
如 基于 前 馈 控制 的 方法 ， 当 摄像 机 速度 可 用 时 ， 通 过 
图 像 测量 和 摄像 机 速度 直接 估计 oe/ar, PRE, H 
式 (24.28) 有 


ðe ^ D^ 
~ =e- Ly, 


ðt 


式 中 ，e 可 以 获得 , 如 e =[e(t) -e(t-At)]/At, 
At 为 控制 周期 。 卡 尔 曼 滤波 器 '* 纪 或 者 更 加 精细 的 
滤波 方法 !* 河 可 用 于 改善 获得 的 估计 值 。 如 果 关 于 
目标 速度 或 者 目标 轨迹 的 知识 是 已 知 的 ， 则 这 些 知识 
完全 可 以 用 于 平滑 或 者 预测 该 运动 “3 。 例 如 ， 
在 参考 文献 [24.59] 中 ， 对 于 视觉 伺服 在 医疗 机 器 
人 的 应 用 ， 对 心脏 与 呼吸 的 周期 性 运动 进行 了 补偿 。 
最 后 ， 还 有 一 些 其 他 方法 已 经 被 研发 出 来 ， 用 于 尽 可 
能 快 地 消除 目标 运动 引起 的 扰动 “3， 例 如 采用 预 
测控 制 器 。 


24.8 ”关节 空间 控制 的 Eye-in- Hand 
和 Eye- to- Hand 系统 


在 前 面 的 小 节 中 ， 我 们 考虑 以 摄像 机 速度 的 6 个 


是 由 于 潜在 的 目标 运动 引起 的 s 的 时 变 ， J 给 出 
如 下 


J, - LX J(q) (24. 33) 


sth, 

1) "X, 是 从 视觉 传感器 坐标 系 到 末端 坐标 系 的 
空间 运动 变换 矩阵 (定义 见 第 1 章 ， 以 及 本 章 式 
(24.15)), ， 它 通常 是 一 个 常数 阵 〈 只 要 视觉 传感器 
固定 于 机 器 人 末端 ) 。 得 益 于 闭环 控制 方案 的 鲁 棒 
性 ， 该 变换 矩阵 的 粗略 近似 对 于 视觉 伺服 已 经 足够 
了 。 如 果 需 要 ， 通 过 经 典 的 手眼 标定 方法 引号 也 能 
够 获得 其 精确 估计 。 

2) J(q) 是 末端 坐标 系 中 机 絮 人 的 雅 可 比 矩 阵 
(其 定义 见 第 1 章 ) 。 

对 于 Eye-to- Hand 系统 ( 见 图 24. 15b), ðs/ðt 是 


由 于 潜在 的 视觉 传感器 运动 引起 的 s 的 时 变 ， 人 可 表 

示 为 
J.= -L°X,"J(q) (24. 34) 
--L'XJ(q) (24.35) 


图 24.15 系统 示意 图 (上 图 ) 和 同样 的 机 器 人 
运动 引起 的 相对 图 像 运动 (下 图 ) 
a) Eye-in- Hand 系统 b) Eye-to- Hand 系统 
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在 式 (24.34) 中 ， 采 用 表示 于 末端 坐标 系 的 经 典 的 
BLAS ARE RI ORR ME' J(q) ， 但 从 视觉 传感器 坐标 系 到 
末端 坐标 系 的 空间 运动 变换 矩阵 "8v 随 着 伺服 而 变 
化 ， 在 控制 方案 的 每 次 迭代 中 均 需 要 估计 ， 
位 姿 估计 方法 进行 估计 。 

在 式 (24.35) P, PLATET KEREJ Cg) 表 
示 于 机 器 人 参考 坐标 系 中 。 只 要 摄像 机 不 运动 ， 从 视 
觉 传 感 偶 坐标 系 到 该 参考 坐标 系 的 空间 运动 变换 算 
MEX, 是 常数 。 在 此 情况 下 便于 实践 ， 而 且 “X, 的 粗 
略 近 似 对 于 视觉 伺服 已 经 足够 了 。 

一 旦 完成 建 模 ， 很 容易 遵循 上 述 采用 的 过 程 设计 
关节 空间 的 控制 方案 ,确定 保证 控制 方案 稳定 的 充分 
条 件 。 再 次 考虑 误差 e =s -s" ,误差 e 以 指数 解 耦 
F, WE 


"8 


通常 采用 


p AE 

peces ot 

WR kan, ZEW 24.1 Th B ZR IEEE ERU 
Q= lle) P, SUR IE Ae JE o — 1 SER 


件 为 


(24. 36) 


JJ: >0 
如 果 丰 >7， 我 们 可 获得 类 似 于 24.1 节 中 
J:J,»0 (24.38) 
以 保证 系统 的 局 部 渐 近 稳定 性 。 注 意 ， 实 际 的 摄像 机 
外 参数 出 现在 中， 而 估计 值 用 于 J*。 因 此 ， 有 可 
能 分 析 控制 方案 关于 摄像 机 外 参数 的 鲁 棒 性 。 采 用 


的 方法 ， 也 有 可 能 直接 估计 也 或 j 的 


(24.37) 


m 


5 


24.2. 8 WHA 
数值 值 。 
最 后 ， 为 消 


除 跟踪 误差 ,我 们 需要 保证 


最 后 ， 需 要 注意 ， 即 使 机 器 人 具有 6 个 自由 度 ， 
用 式 (24.36) 直接 计算 q 通常 也 不 等 价 于 先 用 式 
(24.5) iP v, 再 用 机 器 人 的 道 雅 可 比 导 出 g 。 实 际 
上 ， 有 可 能 发 生 这 样 的 情况 ， 机 恬 人 的 雅 可 比 矩 阵 J 
(q) 是 奇异 的 ,但 特征 雅 可 比 矩 阵 J 了 不 是 C <n 
时 可 能 发 生 )。 此 外 , 伪 逆 的 特性 保证 了 ,采用 式 
(24.5) Ft lly, eb, RH (24.36) B [Lg | 极 小 
—HJ:zJ'(q)'X,L; ， 则 两 种 控制 方案 将 不 同 ， 
导致 不 同 的 机 器 人 轨迹 。 因 此 ， 状 态 空间 的 选择 是 
要 的 。 


o 


MK 


| 四 
Ba 


在 本 章 中 ,我 们 仅 考虑 了 速度 控制 器 ， 它 们 
对 于 大 部 分 经 典 的 机 器 人 手臂 是 便利 的 。 但 是 ， 
对 于 高 速 任务 ， 或 者 我 们 处 理 移动 式 非 限定 性 的 
或 从 驱动 的 机 器 人 时 ， 必 须 考 虑 机 器 人 的 动力 学 。 
对 于 传 感 锅 ， 我 们 仅 考虑 了 来 自 典 型 射影 摄像 机 
的 几何 特征 。 对 于 与 图 像 运 动 相关 的 特征 或 者 来 
自 其 他 视觉 传感器 〈 鱼 眼 摄像 机 ， 反 射 折射 摄像 
机 ， 回 声 图 形 探测 天 等 ) 的 特征 ， 有 必要 重新 考 
虑 建 模 问题 ， 选 择 合 适 的 视觉 特征 。 最 后 ， 在 控 
制 方案 层面 上 融合 视觉 特征 与 来 自 其 他 传感器 的 
数据 (Je Rear, ERRE), RST AA fe 


探索 的 新 的 研究 问题 。 大 量 雄 心 勃 勃 的 视觉 伺服 
应 用 也 可 以 考虑 ， 包 括 室 内 、 室 外 环境 中 的 移动 


机 器 人 人， 航空 、 航 天 、 水 下 机 器 人 和 医疗 机 器 人 
等 。 在 视觉 伺服 领域 ， 富 有 成 效 的 研究 还 一 望 无 
际 ， 远 远 未 到 尽头 。 
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Hugh Durrant- Whyte, Thomas C. Henderson 
刘 冰 冰 i% 


多 传感器 数据 融合 是 将 来 自 数 个 不 同 的 传感器 
的 观测 数据 进行 综合 ， 以 提供 对 环境 或 有 趣 过 程 的 
一 个 鲁 棒 和 完整 的 描述 。 数 据 融 合 在 机 带 人 学 里 面 
的 很 多 领域 具有 广泛 的 应 用 ， 比 如 物体 识别 、 环 境 
地 图 创建 和 定位 。 

这 一 章 具有 三 个 部 分 : 方法 、 结 构 和 应 用 。 大 
多 数 现 有 的 数据 融合 方法 对 观测 和 过 程 采用 概率 性 
描述 ， 并 使 用 贝 叶 斯 定律 将 这 些 信息 进行 综合 。 这 
一 章 调查 了 主要 的 概率 模型 和 融合 技术 ， 包 括 了 基 
于 栅 格 的 模型 、 卡 尔 曼 滤波 和 连续 蒙特 卡 罗 技 术 。 
这 一 章 也 简要 回顾 了 非 概率 性 数据 融合 方法 。 数 据 
融合 系统 常常 是 集成 了 传感器 设备 、 处 理 和 融合 算 
法 的 复杂 系统 。 这 一 章 从 硬件 和 算法 的 角度 提供 了 
对 数据 融合 结构 的 核心 原理 的 概述 。 数 据 融 合 的 应 
j 在 机 器 人 学 和 潜在 的 如 传 感 、 估 测 和 观测 之 类 的 
核心 问题 里 是 无 所 不 在 的 。 我 们 通过 突出 强调 两 个 
例子 的 应 用 来 使 上 述 的 这 些 特征 显现 出 来 。 第 一 个 
例子 描述 了 一 个 自动 驾驶 交通 工具 的 导航 和 自我 追 
踪 。 第 二 个 例子 描绘 了 地 图 创建 和 环境 建 模 的 应 用 。 

数据 融合 的 关键 算法 工具 已 经 合理 地 建立 起 来 


25.1 多 传感器 


在 机 器 人 学 应 用 最 广泛 的 数据 融合 方法 起 源 于 统 
计 学 、 预 测 学 和 控制 等 几 个 领域 。 但 是 ， 这 些 方法 在 
机 器 人 学 中 的 应 用 具有 几 个 独一无二 的 特征 和 难点 。 
寺 别 是 ， 自 动 化 是 最 常见 的 目标 ， 而 结果 必须 采用 一 
种 形式 进行 表示 和 解释 ， 从 而 可 以 做 出 自主 决策 ， 比 
如 ， 在 识别 和 导航 的 应 用 例子 里 。 

在 这 一 节 ， 我们 将 回顾 应 用 于 机 器 人 学 中 主要 的 
数据 融合 方法 。 这 些 方法 常 基于 概率 统计 方法 ， 现 在 
也 的 确 被 认为 是 所 有 机 器 人 学 应 用 里 的 标准 途 
FE") 。 概 率 性 的 数据 融合 方法 一 般 上 是 基于 贝 叶 斯 
定律 进行 先 验 和 观测 信息 的 综合 。 实 际 上 ， 这 可 以 采 
用 几 条 途径 进行 实现 : 通过 卡尔 曼 滤 波 和 延伸 卡尔 曼 
滤波 器 ;通过 连续 蒙特 卡 罗 方 法 ;或 通过 概率 函数 密 


数据 融合 方法 


T, 但 是 ， 这 些 工具 在 机 器 人 学 的 实际 应 用 还 在 发 
展 进化 中 。 
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度 预 测 方法 的 使 用 。 我 们 将 对 每 一 种 途径 进行 回顾 。 
除了 概率 性 方法 外 还 有 一 些 蔡 代 选 择 ， 就 包括 了 证 据 
理论 和 间隔 法 。 这 些 蔡 代 方法 没有 像 之 前 那样 广泛 应 
用 ， 但 是 他 们 还 是 具有 一 些 独 特 的 性 质 。 而 这 些 特 性 
在 一 些 特别 问题 的 解决 上 具有 优势 。 这 些 也 将 进行 简 
要 的 回顾 。 


25.1.1 WHEE 
贝 叶 斯 定律 处 于 大 多 数 数据 融合 方法 的 心脏 部 


位 。 一 般 而 言 ， 贝 叶 斯 定律 提供 了 一 种 对 一 个 物体 或 
者 人 们 感 兴趣 的 环境 进行 推导 的 方法 。 这 些 物体 或 环 
境 在 给 定 一 个 观测 z 的 条 件 下 ,使 用 状态 x 来 描述 。 


1. 贝 叶 斯 推导 
对 离散 和 连续 变量 来 说 ， 贝 叶 斯 定律 分 别 要 求 x 
All z 的 关系 可 以 编码 为 联合 概率 或 联合 概率 分 布 P 
(z，z)。 条 件 概率 的 链接 原理 可 以 在 两 方面 对 一 个 
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联合 概率 进行 扩展 
P(x,z) =P(x |z) P(z) =P(z |x)P(x) 
(25.1) 

以 其 中 一 个 变量 为 条 件 重 写 方程 ， 利 用 贝 叶 斯 定律 得 到 
P(z |x) P(x) 

P(z) 
此 结果 的 价值 在 于 对 这 些 概率 P(x |z) ，P(z |x) 和 
P(x) 的 解释 。 假 设 我 们 需要 决定 一 个 未 知 状 态 x 的 
不 同 数值 的 可 能 性 。 对 x 的 相关 数值 的 猜测 可 能 存在 
着 先 验 概率 ， 而 此 先 验 概率 P(x) 以 相对 可 能 性 的 形 
式 存 在 。 为 了 得 到 更 多 关于 x 的 信息 ， 我 们 做 出 一 个 观 
测 z。 这 种 观测 以 条 件 概率 P(z | x) 的 形式 建 模 。 它 描 
述 了 对 于 任何 固定 的 状态 x， 我们 可 以 做 出 的 观测 为 z 
的 概率 ， 也 就 是 条 件 是 x 时 x 的 概率 。 有 关 状 态 x 的 新 
的 可 能 性 由 最 初 的 先 验 信息 与 从 观测 得 到 的 信息 的 乘 
积 计算 而 得 。 这 个 可 能 性 由 后 验 概率 P(x | zx) 表示， 
它 描述 的 是 基于 观测 z 的 x 的 可 能 性 。 在 融合 的 过 程 
中 ,边缘 概率 P(z) 的 作用 只 是 标准 化 后 验 概率 而 通 
常 不 真正 计算 出 来 。 边 缘 概 率 P(z) 在 模型 验证 和 数 
据 结合 方面 起 重要 作用 ， 因 为 它 提供 了 一 个 尺度 度量 
观测 被 先 验 信息 预测 的 准确 度 ， 而 这 是 因为 P(z) = 
[Pa |x) PGz)dr。 贝 叶 斯 定律 的 价值 在 于 它 提供 了 一 
个 综合 观测 信息 与 有 关 状 态 的 先 验 信息 的 基本 方法 。 

2. 传感器 模型 和 多 传感器 贝 叶 斯 推导 

条 件 概 率 P(z |x) 的 角色 是 一 个 传感器 模型 ， 我 
们 可 以 从 两 方面 加 以 认识 。 第 一 ， 为 了 传感器 建 模 ， 
此 概率 的 构建 需要 得 出 值 x =x， 然 后 有 关 z 的 概率 密 
度 P(z |x=x) 是 多 少 。 相 反 ， 当 这 个 传感器 模型 投 
入 使 用 而 且 做 出 观测 ，z =z 已 经 确定 ， 那 么 基于 zz 的 
概率 函数 P(z =z |x) 就 推导 出 来 了 。 此 概率 函数 ， 
尽管 不 是 一 个 严格 的 概率 密度 ， 对 不 同 的 x 值 造成 的 
观测 值 z 的 概率 进行 建 模 。 此 概率 与 先 验 概率 的 乘积 ， 
二 者 都 取决 于 x， 给 出 了 后 验 概 率 或 者 观测 更 新 
P(x |z)。 在 式 (25.2) 的 实现 中 ，P(z | x) 由 一 个 包 
含 了 两 个 变量 的 方程 构成 (或 在 离散 形式 下 由 一 个 矩阵 
构成 )。 对 x 的 每 一 个 确定 值 ， 一 个 z 的 概率 密度 就 确 
定 了 。 因而 ， 随 x 变化 ， 一 组 有 关 z 的 概率 密度 就 产生 了 。 

贝 叶 斯 定律 的 多 传感器 形式 要 求 条 件 独 立 性 

P(z,--,z,|x) =P(z, |x)--P(z, | x) 


P(x | z) = (25.2) 


(25.3) 
从 而 


P(x |Z") =CP(x) I P(z|x) (25.4) 


式 中 ，C 是 一 个 标准 化 常量 。 式 (25.4) 称 之 为 独立 
概率 池上 ?31 。 这 意味 着 在 所 有 观测 Z" 的 条 件 下 有 关 x 
的 后 验 概 率 ， 仅 仅 正 比 于 先 验 概率 和 每 一 个 信息 源 的 
单个 概率 的 乘积 。 
贝 叶 斯 定律 的 递归 形式 为 
P(z, |x) P(x | Z^!) 
P(z, | Zt) 
式 (25.5) 的 优势 在 于 我 们 仅仅 需要 计算 并 存储 概 
率 密度 P(x |Z …) ， 而 它 包 含 了 过 去 所 有 信息 的 全 
部 概括 。 当 下 一 条 信息 P(z |x) 来 到 时 ， 前 一 个 后 
验 概率 被 当做 当前 的 先 验 概 率 ， 而 这 两 个 的 乘积 ， 经 
标准 化 以 后 ， 就 是 新 的 后 验 概 率 。 
3. 贝 叶 斯 滤波 
当 需 要 维护 一 个 状态 的 概率 模型 而 进行 连续 处 
理 ， 而 这 又 涉及 随时 间 进 化 以 及 得 到 一 个 传感器 对 此 
姿态 周期 性 的 观测 ， 这 时 候 滤波 就 派 上 用 场 了 。 滤 波 
构成 了 解决 跟踪 和 导航 领域 中 的 许多 问题 的 根本 。 通 
常 的 滤波 问题 可 以 用 贝 叶 斯 的 形式 描述 。 这 一 点 是 很 
重要 的 ， 因 为 它 提 供 了 对 一 系列 离散 和 连续 数据 融合 
问题 的 共同 表达 方法 而 不 需要 依赖 某 个 具体 的 目标 或 
观测 模型 。 
定义 x 为 时 刻 ;的 某 一 个 我 们 感 兴趣 的 状态 的 
值 。 此 状态 ,例如 ， 可 能 描绘 了 一 个 待 追踪 的 特征 、 
一 个 被 监视 的 过 程 的 状态 或 者 一 个 需要 获取 其 导航 数 
据 的 平台 的 位 置 。 为 简便 并 不 失 一 般 性 地 ， 时 间 定 义 
为 离散 的 〈 非 同步 的 ) Bi: Ahk。 在 一 个 时 刻 ， 
下 列 变 量 被 定义 : 
xy: 在 时 刻 太 需要 被 估 测 的 状态 向 量 。 
u: 一 个 假定 已 知 的 控制 向 量 ， 作 用 于 时 刻 - 
1 以 驱动 状态 从 x 转变 为 时 刻 记 的 x。 
z,: 在 时 刻 对 状态 x 的 一 个 观测 。 
接着 ， 下 列 变量 集 也 被 定义 : 
1) 状态 的 时 序 记录 : 
Par RE LIP Er 
2) 控制 输入 的 时 序 记 录 : 
U'-ziu,u,,--, uj ={U', ut. 
3) 状态 观测 的 时 序 记录 : 
Z = {20, 215 ty Zi} = {2 zu. 
在 概率 形式 下 ， 通 常数 据 融合 的 问题 是 找到 一 个 
对 所 有 了 时刻 的 后 验 概率 
P(x, | Z", US, x) (25.6) 
于 记录 下 来 的 直到 时 刻 之 前 GPR k) 的 所 有 
测 和 控制 输入 ， 以 及 状态 x 的 初始 值 。 使 用 贝 叶 
定律 可 以 将 式 (25.6) 改写 成 关于 一 个 传感器 模 


P(x |Z‘) = 


(25.5) 


gu 


I ex 
AMI 


第 25 章 多 传感器 数据 融合 117 


HY P(z, | x,) 和 一 个 预测 的 概率 密度 P(x, | Z^, 
U', xo) 的 形式 ， 基 于 直到 时 刻 大 -1 的 所 有 观测 
P(x, | 2 ， U', Xo) 
P(z, | x,) P(x, [z^ , U', XQ) 
= P(z, | Z^! , U*) 
式 (25.7) 的 分 母 与 状态 独立 并 可 以 按照 式 (25.4) 
设 为 某 个 标准 化 常量 C。 传 感 器 的 模型 使 用 了 来 自 式 
(25.3) 的 条 件 独 立 性 假设 。 
使 用 全 概率 定理 可 以 将 式 (25.7) 分 子 中 的 第 
二 项 ， 改 写 为 以 状态 转换 模型 和 来 自 时 刻 夺 -1 的 联 
合 后 验 概率 为 变量 的 方程 
P(x, |Z", U', x) 


(25.7) 


- ILC Xia | z^! , US x,)dx, , 


JP (xi xii) dxia 


0.8 PG) 


P (xxii) 


30 


20 


0 0 


= | Pex, Ix, Z^, Ux) PCS |Z, U, xo) dey, 


E f PG [x ,u,)P(x, , | zi! QUU. xo)dx, ,, 
(25.8) 

式 中 ， 最 后 一 个 等 式 暗示 出 未 来 的 状态 仅仅 取决 于 当 
前 的 状态 和 这 个 时 刻 插 入 的 控制 输入 。 状 态 转 换 模 型 
以 一 个 概率 分 布 P(x xa u,). 的 形式 描述 。 即 是 
说 ， 状 态 的 转换 可 以 很 合理 的 被 假设 为 一 个 Markov 过 
程 ， 也 即 下 一 个 状态 x, 仅 取决 于 前 一 个 状态 x,_, 和 使 用 
的 控制 输入 wu, ， 而 与 观测 量 以 及 再 之 前 的 状态 都 无 关 。 
式 (25.7) 和 式 (25.8) 定义 了 一 个 对 概率 密 
度 式 (25.6) 的 递归 解答 。 式 (25.8) 是 整个 贝 叶 
斯 数据 融合 算法 的 时 间 更 新 或 预测 步 又。 对 此 公式 的 
一 个 图 形 描述 如 图 25. 1 所 示 。 式 (25.7) 是 整个 贝 


Px) 


[P Gus xj i)dx 


图 25.1 完整 的 贝 叶 斯 滤波 器 的 时 间 更 新 步骤 

如 图 25. 1 所 示 ， 在 时 刻 k-1， 对 状态 x;_| 的 认 知 以 概率 分 布 P(x_1) 的 形式 总 结 出 来 。 一 个 机 器 人 模型 ， 以 条 件 
概率 密度 P(x, |x) 描述 了 此 机 器 人 从 时 刻 上 -1 的 状态 x;_1 到 时 刻 记 的 状态 x 的 随机 转变 过 程 。 从 功能 性 来 说 ， 
这 个 状态 转换 与 一 个 形式 为 x; = f(y, 1, ui) 的 潜在 的 机 器 人 状态 模型 相关 。 此 图 显示 了 基于 x,_| 的 固定 值 的 状态 
x 的 两 种 典型 的 条 件 概 率 分 布 P(x | x,_1)。 此 条 件 分 布 与 边缘 分 布 P(x,_1) 的 乘积 ， 描 述 了 x, 的 先 验 概率 值 ， 给 
出 了 显示 于 图 表面 的 联合 分 布 P(x;，xi_1)。 全 边缘 密度 Peu). 描述 了 在 状态 转变 后 对 x 的 认 知 。P(x) 是 通过 对 
所 有 的 x _1 进行 联合 分 布 P(x;，x_1) 的 积分 (投影 获得 的 。 同 样 ， 使 用 全 概率 定理 ， 此 边缘 密度 可 以 通过 对 所 
有 条 件 密 度 P(x |x) 积分 CRA) 得 到 ， 而 P(x | x _1) 的 权 数 是 每 个 x 的 先 验 概率 P(x,_1 ) 。 整 个 过 程 可 
以 逆序 进行 (后 翻 运 动 模型 )， 从 而 在 给 定 模型 P(x x) 的 条 件 下 从 P(x) 得 到 P(xi_1)。 
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叶 斯 数据 融合 算法 的 观测 更 新 步骤。 对 此 公式 的 一 个 ”基于 栅 格 的 方法 和 连续 蒙特 卡 罗 法 ， 都 是 这 些 一 般 性 


图 形 描述 如 图 


25.2 所 示 。 将 要 介绍 的 卡尔 曼 滤 波 、 


方程 的 特殊 实现 。 


P (2x |xx=x1) 


P (z,|xy—x2) 


P(zi—xilxy) 


图 25.2 完整 的 贝 叶 斯 滤波 器 的 观测 更 新 步骤 


如 图 25.2 所 示 ， 做 出 观测 之 前 ， 先 要 建立 以 条 件 概率 密度 P(z | xi) 为 


式 的 观测 模型 。 对 x 的 一 个 固定 值 ， 


比如 x 或 x,， 我 们 定义 概率 密度 函数 P(zi |x, 2x,) X PG, | x, =x.) 以 描述 做 出 观测 为 z4 的 可 能 性 。 概 率 密 


PE P(z, |x) 则 是 z 和 x 的 共同 函数 。 此 条 件 概 率 因 


而 定义 了 观测 模型 。 如 今 ， 在 操作 中 我 们 得 到 一 个 特别 的 观 
W z, =zi 而 导致 的 分 布 P(zs =x, |x) 定义 了 一 个 有 关 xi 的 密度 函数 (现在 称 为 可 能 1 


PAL) 。 此 密度 与 之 前 的 


密度 P(x,” ) 相 乘 ， 经 标准 化 之 后 获得 后 验 概率 P(x | z;)， 从 而 描述 了 进行 观测 后 对 状态 的 认 知 。 


25.1.2 ”概率 型 栅 格 


从 概念 上 来 说 ， 概 率 型 栅 格 是 实现 贝 叶 斯 定律 最 
MATR, EMET AMATER EE, t 
BEW TEIS, 

在 地 图 创建 的 应 用 中 ， 我 们 将 感 兴趣 的 环境 划分 
为 具有 相同 空间 斥 二 单元 的 栅 格 。 每 一 个 单元 编 人 索 
引 并 用 一 个 属性 标识 ， 因 而 状态 x; 可 能 描述 了 一 个 
使 用 详 进 行 索引 而 具有 属性 % 的 二 维 世 界 。 我 们 集中 
兴趣 在 维持 每 一 个 单元 的 可 能 状态 值 P(x;) 的 一 个 
概率 分 布 。 典 型 的 ， 在 导航 和 地 图 创建 问题 中 ， 感 兴 
趣 的 属性 只 有 两 个 值 0 和 五 ， 即 分 别 为 占据 和 空白 ， 


然后 通常 假设 P(x; =0) =1 -P(x; =E), BÆ, 使 
用 状态 x; 进行 编码 的 属性 并 没有 特殊 的 限制 ， 它 可 
能 有 很 多 值 (比如 绿 、 红 、 蓝 ) 或 可 能 是 连续 的 
(比如 一 个 单元 的 温度 ) 。 

当 状 态 的 定义 已 经 确定 ， 贝 叶 斯 方法 要 求 一 个 传 
感 器 模型 或 者 这 个 传感器 的 可 能 性 函数 建立 起 来 。 理 
论 上 ， 这 要 求 确定 一 个 概率 分 布 P(z |x; =x), A 
将 每 一 个 可 能 的 单元 状态 x; 与 观测 的 分 布 建立 联系 。 
但 是 , 实际 上 ， 这 可 以 简单 地 用 男 一 个 观测 栅 格 实 
现 ， 因 此 对 一 个 特定 的 观测 z =z (在 一 个 特定 的 位 
置 取得 ) ， 一 个 关于 状态 六 的 可 能 性 栅 格 以 P(z = 
xj) =A (x,) 的 形式 产生 。 然 后 运用 贝 叶 斯 定律 


Zz 
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对 每 一 个 机 格 单元 的 属性 值 进行 更 新 就 很 容易 了 
P*(x,) =CA(x,)P(x,), Vi,j (25.9) 
tH, C 是 一 个 标准 化 常量 ， 它 是 通过 节点 立 上 所 有 
的 后 验 概率 之 和 获得 的 。 从 计算 上 来 说 ， 此 运算 是 一 
个 简单 的 对 两 个 单元 的 逐 点 相 乘 。 需 要 特别 注意 的 
是 ， 两 个 栅 格 适当 重 羡 并 以 正确 的 比例 排列 。 在 某 些 
例子 里 ， 值 得 将 空间 邻近 的 单元 互相 影响 这 个 事实 编 
人 码 。 即 是 说 ， 如 果 我 们 知道 单元 格 立 的 属性 值 (比如 
占据 性 、 温 度 ) ,我们 也 会 知道 相 令 单元 格 i + 1, j， 
i, j+1 等 属性 的 可 能 性 。 不 同 的 传感器 和 相 异 传 感 右 
融合 的 输出 可 以 通过 适当 的 传感器 建 模 A(x;) 获得 。 
栅 格 也 可 以 应 用 于 追踪 和 自我 追踪 (ETE). TE 
这 里 状态 x; 是 被 追踪 的 位 置信 息 。 从 定性 的 角度 考 
虑 这 是 一 个 跟 之 前 在 地 图 创建 里 使 用 的 不 同 的 状态 定 
义 。 概 率 P(x;) 现在 必须 解释 为 被 追踪 的 物体 占有 
栅 格 单 元 站 的 可 能 性 。 在 地 图 创建 里 ， 每 个 栅 格 单元 
的 属性 概率 之 和 是 1， 但 是 在 追踪 里 ， 所 有 单元 格 的 
位 置 可 能 性 之 和 必须 是 1。 除 此 之 外 ， 更 新 的 步骤 都 
是 相似 的 。 我 们 构造 一 个 观测 栅 格 ， 充 实 以 观测 值 ， 
提供 一 个 位 置 概率 的 栅 格 P(z=z |x;) =A(x;)。 然 
后 应 用 贝 叶 斯 定律 ， 采 用 与 式 (25.9) 里 相同 的 形 
式 更 新 每 一 个 栅 格 单元 的 位 置 概率 。 仅 有 的 区 别 是 现 
在 标准 化 常量 C 的 获得 是 将 所 有 立 栅 格 单元 格 的 后 验 
概率 相 加 。 尤 其 是 当 栅 格 具有 三 个 或 更 多 维 的 时 候 ， 
这 可 能 需要 很 大 的 计算 量 。 基 于 栅 格 追踪 的 优势 是 比 
较 容 易 插 人 比较 复杂 的 先 验 信息 。 比 如 ， 如 果 知 道 被 
追踪 的 物体 位 于 一 条 路 上 ， 那 么 所 有 路 面 外 的 栅 格 单 
元 格 的 位 置 属性 概率 就 可 以 设置 为 0。 
基于 栅 格 的 融合 适宜 应 用 的 情境 是 环境 的 空间 尺 
十 和 维 数 不 大 的 时 候 。 此 时 ， 基 于 栅 格 的 方法 提供 直 
接 而 有 效 的 融合 算法 。 基 于 栅 格 的 方法 可 以 进一步 延 
JE. 等 级 性 〈 四 项 树 ) 栅 格 或 不 规则 (三 角形 、 多 
角形 ) 栅 格 。 这 些 可 以 帮助 减少 在 大 规模 空间 应 用 
的 计算 量 。 蒙 特 卡 罗 和 粒子 滤波 方法 ( 见 第 25.1.4 
节 ) 可 认为 是 基于 栅 格 的 方法 ， 而 栅 格 单元 本 身 可 
以 认为 是 状态 的 潜在 概率 密度 的 样本 。 


25.1.3 卡尔 曼 滤 波 器 


卡尔 曼 滤 波 器 是 一 种 线性 递归 估算 器 。 在 对 状态 
周期 性 的 观测 基础 上 ， 它 成 功 地 计算 出 一 个 随时 间 进 
化 的 连续 值 状 态 的 估算 值 。 卡 尔 曼 滤波 带 采 用 的 是 兴 
趣 状态 参数 x(1) 如 何 随时 间 进 化 的 显 式 随机 模型 ， 
以 及 与 此 参数 相关 的 观测 z(t) 是 如 何 得 到 的 显 式 随 
机 模型 。 卡 尔 曼 滤波 器 所 使 用 的 权 数 的 选择 是 为 了 确 
保 ， 在 观测 模型 和 处 理 模型 使 用 的 某 些 假设 条 件 下 ， 


使 求 得 的 估算 x(t) 的 均 方差 最 小 化 ， 而 且 条 件 均 值 
x(t) - E(x(£) |2'] 是 一 个 平均 值 而 不 是 一 个 最 可 能 
的 值 。 

卡尔 曼 滤波 器 拥有 一 些 特性 使 得 它 很 理想 地 适用 
于 处 理 复 杂 的 多 传感器 预测 和 数据 融合 问题 。 特 别 
是 ， 对 处 理 过 程 和 观测 进行 显 式 的 描述 允许 一 个 很 广 
范围 的 不 同 传感器 模型 可 以 轻易 应 用 于 基本 算法 中 。 
另外 ， 对 未 知 量 进行 统计 测量 的 一 致 性 使 用 ， 使 得 定 
量 评估 每 一 个 传感器 在 整个 系统 性 能 中 起 到 的 作用 成 
为 可 能 。 更 进一步 地 ， 此 算法 线性 递归 的 本 性 确保 了 
它 的 应 用 简单 而 有 效 。 基 于 所 有 这 些 原因 ， 卡 尔 曼 滤 
波 屁 在 很 多 不 同 的 数据 融合 问题 都 有 广泛 的 应 用 1。 

在 机 需 人 学 里 ， 卡 尔 曼 滤波 器 更 适用 于 追踪 、 定 
位 和 导航 ， 而 不 太 适 用 于 地 图 创建 。 这 是 因为 此 算法 
在 状态 描述 定义 明确 的 情况 下 (比如 位 置 、 速 度 ) 
工作 得 很 好 ， 而 对 那些 观测 和 时 间 传 播 模型 的 状态 也 
理解 得 很 好 。 

1. 观测 与 转变 模型 

在 状态 的 概率 密度 是 高 斯 分 布 的 情况 下 ， 卡 尔 曼 
ace UT LEE GS VH N RUE Eds (3X 25.7 和 式 
25.8) 的 特别 例子 。 卡 尔 曼 滤波 器 算法 的 起 点 是 为 
状态 定义 一 个 可 以 使 用 标准 的 状态 空间 形式 进行 预测 
的 模型 . 

x(t) =F(t)x(t) +B(t)u(t) +G(t)v(t) (25.10) 
SUP, x(t) 是 我 们 感 兴趣 的 状态 向 量 ; wu(1) 是 已 知 
的 控制 输入 ; va) 是 一 个 描述 在 状态 进化 中 不 确定 
因素 的 随机 变量 ; F(t), BU) AG (+) 是 描述 状 
态 、 控 制 和 噪声 对 状态 转变 贡献 的 矩阵 中 。 一 个 观 
iU (输出 ) 模型 也 被 采用 标准 的 状态 空间 形式 定义 : 

Z(t) 2 H(t)x(t) +D(t) w(t) (25. 11) 
SUP, z(t) 是 观测 向 量 ; w(t) 是 描述 观测 中 不 确定 
性 的 随机 变量 ; HO) MDU) 是 描述 状态 和 噪声 对 
观测 的 贡献 的 矩阵 。 
这 些 方程 定义 了 连续 系统 的 进化 以 及 针对 状态 做 
出 的 连续 观测 。 但 是 ， 卡 尔 曼 滤波 器 几乎 总 是 以 离散 
的 时 间 t, = 大 实现 的 。 可 以 从 式 (25.10) 和 式 
(25.11) 直接 得 到 离散 形式 
x(k) =F(k)x(k-1) +B(k)u(k) +G(k)v(k) 
(25. 12) 
z(k) -H(k)x(k) +D(k)w(k) (25.13) 
推导 卡尔 曼 滤波 器 使 用 的 一 个 基本 假设 是 ， 描 述 
处 理 和 观测 噪声 的 v(k) 和 w(k) 都 是 高 斯 的 、 时 间 
上 不 相关 的 以 及 拥有 零 均值 
E[v(k)] E[w(k)] 20, Vk 


1 


(25.14) 
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有 具有 已 知 的 协 方差 此 预测 的 方差 定义 为 此 预测 的 均 方差 
edi ad PG |j AEI -XG D Ie) -5G [DT |Z 
EL w(i)w'(j) ] =6,R(i) (25. 15) (25. 18) 
EE Bea 在 时 刻 k， 在 给 定 所 有 至 时 刻 HO ELE B ATE, A 


Blew) -0， Wid 《25 16) 直 的 预测 写作 (| 如 。 在 时 刻 上 在 给 定 只 有 时 刻 有 
这 些 相 等 于 一 个 要 求 观测 和 连续 状态 条 件 独立 的 马尔 ”一 sie à > ee em ee a. m 
可 夫 (Markov) MERE, WEE (OR 和 w(k) 时 间 上 相 的 信息 的 条 件 下 ， 状 态 的 预测 称 为 向 前 一 步 预测 
关 ， 可 以 使 用 一 个 成 形 滤 波 器 (sharping filter) 将 观 (或 一 次 预测 ) ， 写 为 x(k k-1), 
测 进行 白化 处 理 ， 就 能 获得 卡尔 曼 滤 波 吉 要 求 的 假设 现在 我 们 仅 给 出 卡尔 曼 滤 波 器 算法 而 不 子 证 明 。 
AEDS 。 如 果 处 理 和 观测 噪声 序列 相关 ， 那 么 这 种 详细 的 推导 可 以 在 许多 关于 此 问题 的 书 里 找到 ， 比 如 
相关 性 也 可 以 在 卡尔 曼 滤 波 器 算法 中 得 到 解决 中 。 ”参考 文献 [25.7，8]。 描 述 的 状态 假设 根据 式 
如 果 序 列 不 是 高 斯 分 布 的 ， 但 具有 对 称 的 有 限 模 数 ， (25.12) 随时 间 进 化 。 此 状态 的 观测 根据 式 
卡尔 曼 滤 波 器 还 是 可 以 产生 很 好 的 估算 。 但 是 ， 如 果 — (25.13) 在 固定 的 时 间 间 隔 得 到 。 进 入 系统 的 噪声 
序列 有 一 个 斜 的 或 病态 分 布 ， 那么 卡尔 曼 滤波 器 产生 ”过 程 假定 遵循 式 (25.14), 式 (25.15) 和 式 
的 结果 就 有 偏差 ， 而 使 用 更 复杂 的 贝 叶 斯 滤波 器 天 3 (25. 16) 。 同 时 还 假设 交 -1 | k-1) ÆRA x(k- 


是 个 好 的 选择 。 1) 在 时 刻 k- 1， 在 基于 所 有 直到 时 刻 h -1 之 前 
2. 滤波 器 算法 (并 包括 -1) 的 观测 被 做 出 的 预测 。 而 此 预测 等 同 
在 给 定 观测 的 条 件 下 ， 卡 尔 曼 滤波 铬 算法 产生 的 。 真正 的 状态 x(-1) 基于 所 有 这 些 观测 的 条 件 均值 。 
ee) HOLE TRUTH 而 该 预测 的 条 件 方差 Pt = 1 | k - 1) 也 假定 已 知 。 卡 
x(G |j) &E[xG) |z(0) zG] ABLx(i) |z] 尔 曼 滤波 器 就 分 两 步 递归 运行 ( 见 图 25.3)。 
(25.17) 
真实 状态 状态 估算 状态 协 方差 计算 


ety PY A RASTER Ze 
协 方差 


在 时 刻 的 控制 
u(k) P(k-1|k-1) 


Tt, 1 时 刻 的 状态 估算 
x(k-1|k-1) 


状态 预测 
x(k|k-1) — 
F(k) x (k-A|k-1) + G(k) u(k) 


状态 预测 协 方差 
P(k\k-1) = 
F(k)P(k-l|k-1) F(k) + O(k) 


状态 转换 
x(k) = F(k)x (k-1) 
+ G(k)u(k) * v(k) 


革新 协 方差 
S(k) = 
有 DPIEDEOD+ROD 


在 # 时 刻 的 测量 测量 预测 
z(k) = H(k)x (k) + w(k) z(k|k-1) = 
HO x (k|k-1) 


滤波 器 增益 
Wk) = 
P(k|k-1)H' (k) S ^ (k) 


革新 
v(k) = z(k)-z(k|k-1) 


更 新 的 状态 协 方差 
P(k|k) = 
P(k|k-1)-W(Kk) S(k) W(K) 


更 新 的 状态 估算 
x(k|k) = 
x(k|k-1)*- W(k)v(K) 


图 25.3 卡尔 曼 滤 波 器 循环 的 框图 (根据 Bar- Shalom 和 Fortmann Rz E71 ) 
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(1) 预测 “一 个 状态 在 时 刻 上 的 预测 x( | 一 1) 
和 它 的 协 方差 P(E |k-1) 可 以 如 下 算出 
x(k|k-1) =F(k)x(k-1 |k-1) € B(E)u(k) 
(25.19) 
P(k|k-1) 2F(k)P(k | k-1)F"(k) -«G(E)QUEk)G (Kk) 
(25. 20) 
(2) 更 新 在 时 刻 上 做 出 观测 z (E), E AIAR 
AS x(k) 的 预测 x(k |k) 以 及 更 新 的 预测 协 方差 
P(k |) 可 以 如 下 算出 
x(k|k) 2x(k |k-1) +W(k)[2(k) - 


H(k)x(k |k-1)] (25.21) 
P(k |k) =P(k | k-1) -W(E)S(E)W' (E) 
(25.22) 
sth, EE W) 是 
W(k) 2P(k|k-1)H(k)S^ (k) (25.23) 
革新 协 方差 S(k) 是 
S(k) =R(k) +H(k)P(k |k- 1) H(k) 
(25.24) 
观测 z (E) 和 通过 预测 得 到 的 观测 EC) x(k | k - 1) 
zn] BS 2E BR A FBT IRIE vhk): 

v(k) 2z(k) -H(k)x(k|k-1) (25.25) 
革新 是 描绘 滤波 器 预测 值 和 观测 序列 差异 的 一 个 重要 
测量 值 。 实 际 上 ， 因 为 状态 的 真实 值 不 总 是 能 够 被 得 
到 ， 从 而 与 预测 的 状态 进行 比较 ， 革 新 就 是 测量 估算 
器 性 能 的 唯一 测量 值 。 革 新 在 数据 关联 (data associ- 
ation) 里 面 特别 重要 。 

3. 延伸 卡尔 曼 滤 波 器 

延伸 卡尔 曼 滤 波 器 (EKF) 是 卡尔 曼 滤 波 器 的 一 
种 变 体 ， 它 适用 于 当 状 态 模 型 和 /或 观测 模型 是 非 线 
性 的 情况 下 。EKEF 在 本 节 做 简要 介绍 。 

EKF 考虑 的 状态 模型 在 状态 空间 符号 系统 里 以 
一 阶 非 线 性 向 量 差 分 方程 的 形式 表示 

x(t)=f[x(t), u(t), v(t), t] (25.26) 
AP, fle, +, +, +] 现在 是 一 个 普通 的 将 状 
态 和 控制 输入 投入 到 状态 转换 中 的 非 线 性 方程 。EKF 
考虑 的 观测 模型 在 状态 空间 符号 系统 里 以 一 个 非 线性 
向 量 方程 的 形式 表示 

z(t) =h[ x(t), u(t), v(t), t] (25.27) 
RP, h [-, +, +, +) 现在 是 一 个 普通 的 将 状 
态 和 控制 输入 转换 到 观测 中 去 的 非 线 性 方程 。 

像 卡尔 曼 滤 波 器 一 样 ，EKF 几乎 总 是 以 离散 时 
间 实 现 。 通 过 集成 和 对 离散 时 间 状 态 和 观测 的 适度 辩 


pr 


识 ， 离 散 的 状态 模型 可 以 写 为 
x(k) =flx(k-1), u(k) , v(k) , k] (25.28) 
而 观测 模型 是 
z(k) 2h[x(k) , w(k)] (25.29) 
像 卡尔 曼 滤 波 器 一 样 ，EKF 假设 噪声 v(k) 和 w(k) 
都 是 高 斯 的 、 时 间 上 不 相关 的 以 及 拥有 零 均 值 ， 正 如 
X (25.14) ~ 式 (25.16) 描述 的 那样 。EKF 致力 于 
将 均 方差 最 小 化 从 而 计算 出 条 件 均 值 的 一 个 近似 值 。 
因而 它 假设 在 时 刻 k -1 状态 的 预测 近似 等 于 条 件 均 
fH, Elx(k-1|k-1)~E[x(k-1) | Z-'J, 我们 现 
在 不 做 证 明 的 表述 EKF 算法 。 具 体 的 推导 可 以 参见 
任何 有 关 此 课题 的 参考 书 。EKF 推导 的 主要 步骤 遵 
循 线性 卡尔 曼 滤 波 器 的 步骤 ， 只 是 增加 了 额外 步骤 ， 
分 别 使 用 有 关 估 算 和 预测 的 泰勒 序列 将 处 理 和 观测 模 
型 线性 化 。EKF 算法 分 为 两 步 ， 预 测 和 更 新 。 
(1) 预测 “一 个 状态 在 时 刻 诺 的 预测 *(E | 大 -1) 
和 它 的 协 方差 P(E | 大 -1) 计算 如 下 
x(k|k-1) 2 flx(k-1 |k-1), u(k)] 
(25. 30) 
P(k|k-1) 2 Vf,.(k)P(k-1]|k -1) Vr f. (E) + 
Vf, Ck) QUE) V" f, Ck) (25.31) 
(2) 更 新 在 时 刻 上 做 出 观测 z(F) ， 更 新 的 状 
dxx(k) 的 预测 x(k |k) 以 及 更 新 的 预测 协 方差 
P(k |) 计算 如 下 
x(k|k) 2x(k |k-1) + W(k) lz(k) - h[x(k | k-1)]] 


(25.32) 
P(k|k) =P(k | k-1) -W(E)SCE)W' (E) 
(25.33) 
式 中 
W(k) 2P(k|k -1) Vh, (k) S~ (k) (25.34) 
以 及 


S(k) =V h, CE) RE) Vh, (k) + 
Vh, (E) PCR | E- 1) Vh, Ck) 
式 中 ， 雅 可 比 行列 式 yf(k) TE x(k-1) 2x(k-1 
| 一 1) 时 被 评估 ;而 雅 可 比 行列 式 y h(k) TE x(k) 


=X( 记 | 有 -1) 的 时 候 评估 。 

比较 式 (25.19) ~ 式 (25.24) 和 式 (25.30) ~ 
式 (25.35) 可 以 清楚 地 看 出 EKF 算法 近似 于 线性 的 
卡尔 曼 滤 波 器 算法 ， 只 要 在 方差 和 增益 的 传播 方程 中 
进行 替换 FF(k) 一 Vf.(k) AM H(k)—Vh,(k) 就 行 
To KAM, EKF, 实际 上 是 对 状态 误差 的 线性 估算 
器 ， 而 状态 误差 则 是 由 一 个 线性 方程 摘 述 ， 进 而 由 一 


(25. 35 ) 
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个 线性 方程 以 式 (25. 13) 为 形式 观测 的 。 
EKF 与 线性 卡尔 曼 滤 波 器 在 很 大 程度 上 相似 ， 
只 是 有 些 显 著 的 特点 需要 进行 说 明 : 

1) 雅 可 比 行列 式 Yf.(k) FIV A, Ck) 通常 不 是 
常量 ， 而 是 状态 和 时 间 两 者 的 函数 。 这 意味 着 与 线性 
滤波 器 不 同 ， 随 着 预测 和 估算 的 计算 ， 协 方差 和 增益 
和 矩阵 必须 实时 计算 出 来 ， 并 且 一 般 上 不 趋向 于 常量 。 
这 显著 增加 了 算法 需要 实时 运算 的 计算 量 。 

2) 因为 线性 化 模型 的 推导 是 赎 绕 预测 或 名 义 上 
的 轨迹 对 真正 的 状态 预测 和 观测 模型 扰动 进行 的 ， 所 
以 必须 十 分 小 心 以 确保 这 些 预 测 总 是 足够 接近 真实 状 
态 ， 而 线性 化 的 第 二 阶 项 其 实 是 很 小 的 。 如 果 名 义 轨 
迹 距 离 真 正轨 迹 过 远 ， 那 么 真正 的 协 方差 将 比 估 测 的 
协 方差 大 很 多 ， 而 滤波 器 的 配 准 就 变 得 很 糟糕 。 在 极 
限 情况 下， 滤波 器 甚至 可 能 变 得 不 稳定 。 

3) EKF 采用 一 个 必须 由 状态 的 近似 值 计算 出 来 
的 线性 化 模型 。 不 像 线性 滤波 器 ， 这 意味 着 EKF 必 
须 从 操作 的 一 开始 就 准确 赋值 ， 以 保证 线性 化 模型 的 
获得 是 有 效 的 。 如 果 不 这 么 做 ， 滤 波 器 算出 来 的 预测 
将 毫 无 意义 。 

4. 信息 滤波 器 

信息 滤波 器 在 数学 上 等 同 于 卡尔 曼 滤 波 器 。 但 
E, 不 像 后 者 生成 状态 预测 x(i |j) 和 协 方差 
P(i |j) ,信息 滤波 器 使 用 信息 状态 变量 y(i |j 和 信 
EERE 了 (i |)) ， 两 组 之 间 的 联系 是 

»G|p =P 'G |pxG |) 
Yi lj) =P (i |j) (25.36) 
信息 滤波 器 具有 与 卡尔 曼 滤 波 器 相同 的 预测 一 更 新 
结构 。 

(1) 预测 “一 个 信息 状态 在 时 刻 开 的 预测 了 (下 
|k-1) 和 它 的 信息 矩阵 了 (大 | 大 -1) 可 以 分 别 计算 
如 下 (Joseph JERI! ) 

y(k|k-1) 2 (A- QG )F "y(k-1|k-1) + 


Y(k | k- 1) Bu(k) (25.37) 
Y(k|k-1) =M(k) -QDQ" — (25.38) 
式 中 ， 
M(k) F"Y(k-1]|k-1)F^ 
Y-G'M(k)G«Q" 
而 


Q-M()GX ^ 
MATE, E mR CERAR Q2， 具 有 与 处 
理 驱动 噪声 相同 的 维 数 ， 而 通常 它 比 状态 的 维 数 小 很 


多 。 Hh, SERE F-' JT GS PE fh BS GS Fe ME 
阵 ， 因 而 必须 始终 存在 。 

(2) 更 新 在 时 刻 太 做 出 观测 z(&) ， 更 新 的 信 
息 状态 预测 y(K |k) 以 及 更 新 的 信息 矩阵 了 (大 |k) 
计算 如 下 

y(k |k) =y(k |k-1) e HCE) R^ (k)z(k) 

(25.39) 

Y(k|k) =¥(k | k-1) - H(E)R (Kk) H'(k) 

(25.40) 
要 强调 的 是 式 (25.37) 和 式 (25.38) 在 数学 上 等 
同 于 式 (25.19) 和 式 (25.20), ， 而 式 (25.39) 和 
式 (25.40) 在 数学 上 等 同 于 式 (25.21) M 
(25. 22) 。 需 要 注意 的 是 信息 和 状态 空间 形式 上 的 二 
元 性 5 中。 这 种 二 元 性 其 实 是 很 明显 的 ， 因 为 在 信 
息 滤波 器 的 预测 步骤 里 Q 生起 到 的 作用 ， 与 增益 
和 矩阵 W 和 革新 协 方差 S 在 卡尔 曼 滤 波 器 的 更 新 步骤 
里 起 到 的 作用 是 相同 的 。 而 且 ， 卡 尔 曼 滤波 器 简单 的 
信息 预测 步 又 也 印证 了 信息 滤波 器 简单 的 线性 更 新 
ORR 

比 起 卡尔 曼 滤 波 器 ， 信 息 滤 波 器 在 数据 融合 问题 
上 最 大 的 优势 在 于 其 更 新 步 又 的 相对 简洁 。 对 一 个 有 
n 个 传感器 的 系统 来 说 ， 融 合 信息 状态 的 更 新 确切 地 
说 就 是 来 自 所 有 传感器 的 信息 贡献 的 线性 和 ， 见 式 
(25. 41) 。 


YCE |k) =9(k |k- 1) + Y, HAR ! G)2(0) 
Y(k|k) =¥(k|k-1) + Y H,(E) R/ (Kk) HT (k) 


(25.41) 
这 种 表达 方式 存在 的 原因 是 信息 滤波 器 本 质 上 是 贝 叶 
斯 定律 关于 概率 的 对 数 表 示 ， 因 而 概率 的 乘积 CX 
(25.4)) 变 成 了 求 和 。 而 对 卡尔 曼 滤 波 器 ， 多 传 感 
器 的 更 新 就 没有 这 种 简洁 的 表达 方式 了 。 信 息 传感器 
的 这 种 特性 被 应 用 于 机 器 人 网 络 的 数据 融合 3， 
以 及 近来 机 器 人 导航 与 定位 问题 改 0 。 信 息 滤 波 器 的 
一 个 主要 劣势 在 于 非 线性 模型 的 编码 ， 尤 其 是 在 预测 
步骤 里 。 
5. 使 用 卡尔 曼 或 信息 滤波 器 的 时 机 
当 我 们 感 兴趣 的 物理 量 是 使 用 连续 参数 状态 定义 
的 时 候 ， 卡 尔 曼 或 信息 滤波 器 就 很 适用 于 此 类 数据 融 
合 问题 。 这 种 物理 量 包 括 对 一 个 机 器 人 或 其 他 物体 位 
置 、 角 度 和 速度 的 预测 ， 或 对 一 个 简单 几何 特征 ， 比 
如 点 、 线 或 曲线 的 追踪 。 当 物理 量 的 特征 不 易 参 数 化 
的 时 候 ， 比 如 空间 占据 性 、 离 散 的 标签 或 过 程 ， 就 不 


加 | 
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适合 使 用 卡尔 曼 或 信息 滤波 融 进 行 预测 了 。 
连续 蒙特 卡 罗 方 法 


蒙特 卡 罗 (MC) 滤波 器 方法 用 概率 分 布 的 方式 
对 一 个 隐 含 的 状态 空间 的 一 组 加 权 采 样 进 行 描述 。 
MC 滤波 器 通常 通过 贝 叶 斯 定律 来 使 用 这 些 采 样 进行 
概率 推导 的 仿真 ， 使 用 的 采样 或 仿真 数 是 很 大 的 。 通 
过 研究 这 些 采 样 经 过 推导 过 程 的 统计 特性 ， 仿 真 过 程 
的 概率 图 形 就 建立 起 来 了 。 

1. 概率 分 布 的 表示 

在 连续 绽 特 卡 罗 方 法 里 ， 概 率 分 布 的 描述 是 通 
使 用 一 系列 支撑 点 (状态 空间 值 ) x’, i=l, +, 
及 对 应 的 一 组 标准 化 了 的 权 数 w ,i=1，…, N XE 


25. 1.4 


= & 


NE 


Bras 

ÍTR, iii X,w =1。 支 撑 点 和 权 数 可 以 用 以 定义 一 个 
概率 密度 函数 

P(x) = Y w'd(x —x') (25. 42) 


如 何 选 择 支 撑 点 和 权 数 以 获得 此 概率 密度 P(x) 的 合 
理 表 示 是 一 个 关键 问题 。 最 常用 的 选择 支撑 点 的 方法 
是 使 用 一 个 重要 性 密度 q(x) 。 支 撑 点 x 是 对 此 密度 
进行 的 采样 ;， 如果 此 密度 具有 较 大 的 概率 ， 较 多 的 采 
样 就 被 选择 出 来 ， 反 之 则 反之 。 式 (25.42) 中 的 权 
数 由 式 (25.43) 算出 


20 oc 


q(x") 
实际 上 ， 一 个 支撑 点 采样 x' 是 从 重要 性 分 布 取 得 的 。 
此 采样 从 隐 含 的 概率 分 布 中 初始 化 以 产生 概率 值 
P(x=x'), aS q(x) 相 比 并 进行 适当 的 标准 化 就 
得 到 权 数 。 
重要 性 取样 法 有 两 个 有 益 的 极端 例子 。 
1) 在 一 个 例子 里 ， 重 要 性 密度 可 以 采取 平均 分 
布 的 形式 ， 从 而 支撑 点 x' 是 平均 分 布 于 状态 空间 的 ， 
与 栅 格 的 形式 很 接近 。 每 一 个 概率 g(x) 因此 是 相 
等 的 。 从 式 (25.43) 计算 来 的 权 数 因而 正比 于 概 
AR, wcP(z =z)。 分 布 的 模型 结果 看 上 去 很 像 规矩 
栅 格 模型 。 

2) 另 一 个 极端 例子 里 ,我们 选择 重要 性 分 布 等 
同 于 概率 模型 ， 即 g(x) = P(x)。 支 撑 点 采样 x' 现 在 
从 此 密度 取得 。 此 密度 若 具有 较 大 的 概率 ， 较 多 的 采 
样 就 被 选择 出 来 ， 反 之 则 反之 。 但 是 ， 如 果 我 们 将 
g(x') =P(x') 代入 式 (25.43) 中 ,可 以 清楚 地 看 
到 所 有 的 权 数 w = 1/N。 一 组 具有 相同 权 数 的 采样 
( 称 为 粒子 分 布 ) 就 产生 了 。 

当然 ， 也 可 能 将 这 两 种 表示 方法 融合 ， 既 使 用 一 
组 权 数 又 使 用 一 组 支撑 点 对 一 个 概率 分 布 进行 描述 。 


(25.43) 


描述 概率 分 布 的 采样 与 权 数 的 完备 集 fx’, wi BK 
称 为 随机 测量 。 

2. 连续 蒙特 卡 罗 法 

连续 蒙特 卡 罗 (SMC) 滤波 器 是 对 递归 贝 叶 斯 
更 新 方程 的 仿真 ， 使 用 支撑 采样 值 和 权 数 来 描述 隐 含 
的 概率 分 布 。 

方法 的 起 点 是 在 式 (25.7) 和 式 (25.8) 给 出 
的 递归 或 连续 贝 叶 斯 观测 更 新 。SMC 递归 开始 于 由 
一 组 支撑 数值 和 权 数 xa. wei ai itp RÀ HU 
验 概率 密度 


Pixa | Zh) = Y wi 8 oxi) 

(25. 44) 

预测 步骤 需要 将 式 (25.44) 代入 式 (25.8), ， 从 而 

使 联合 密度 被 边缘 化 。 但 是 ， 在 实际 应 用 中 ， 我 们 假 

设 重要 性 密度 就 是 转变 模型 ， 见 式 (25.45) 从 而 避 
免 这 个 复杂 的 步 又 

qu) =POz [i ) (25.45) 

fo VEL Sc PERS xi IH BO SE PEME xL H SERE EJ 

， 但 是 权 数 保留 不 变 wi =wi_,。 从 而 ， 预 测 变 为 


dm Dx 


NE 
P(x, |Z) = 2 wi ,9(x,-x;) (25.46) 


SMC 的 观测 步骤 相对 简单 。 先 定义 一 个 观测 模型 P 
(zs |x;) ， 它 是 两 个 变量 z, 和 x 的 函数 ， 且 是 关于 z, 
的 一 个 概率 分 布 (积分 为 单位 1)。 当 得 到 一 个 观测 
或 测量 ，z = z,， 观 测 模型 变 为 仅 是 状态 xi 的 函数 。 
如 果 状 态 采 样 是 x, Tai, i=1, =, N, WWR P 
(z, =z |x, =x.) 变 为 一 组 描述 采样 x 产生 观测 z, f] 
概率 的 标量 。 将 此 概率 和 式 (25.46) 代入 式 
(25.7) 得 


P(x, [Z*) =¢ Y, ui ,P(z, 2 |x, -xi)8(, -x1) 
(25.47) 

此 式 通常 以 _ 组 更 新 的 标准 化 了 的 权 数 来 实现 

wy ,P(z, = 2, |x, = xj) 


Ne. : 
ICI = £y | x, = x) 


(25. 48) 


i 
Ww, 三 


因此 有 


P(x, |Z') = £ w ò(x, -xi ) 


生意 式 (25.49) 中 的 支撑 值 与 式 (25. 46) 中 的 相 
同 ,仅仅 是 权 数 被 观测 更 新 改变 。 

SMC 法 的 实现 同时 需要 状态 转变 模型 P(x, 
|x;_1) 和 观测 模型 P(z, | x;)。 这 些 模型 需要 采取 


(25. 49) 


i 


124 第 3 篇 


能 允许 z,，xi 和 x,_, 样 本 化 的 一 种 形式 。 对 低 维 状态 
空间 来 说 ， 使 用 查找 表 插 值 是 可 行 的 一 种 表示 法 。 对 
高 维 状 态 空间 来 说 ， 更 适用 的 模型 是 提供 函数 表 
示 法 。 

KRE, 式 (25.46) MIÈ (25.47) 按 下 列 描 
述 实 现 。 

(1) 时 间 更 新 ”一 个 处 理 模 型 定义 成 一 个 通常 
的 状态 空间 形式 ,x = f(x, 1， Wao’ k), XP, w, 
是 已 知 概率 密度 为 P(w,) 的 独立 噪声 序列 。 预 测 步 
又 实现 如 下 : 有 WN, 个 采样 w;，i =1,，…，NN; 从 分 布 
P(wi) 取 出 。N, 个 支撑 值 x 与 wi 一 起 传输 给 处 理 
模型 


x, = f(x, wi VUE) (25. 50) 
从 而 产生 新 的 一 组 支撑 值 x;， 权 数 不 变 。 实 际 上 ， 
该 处 理 模 型 被 简单 地 使 用 N, 次 进行 状态 传播 仿真 。 
(2) 观测 更 新 ”一 个 观测 模型 定义 成 一 个 通常 
的 状态 空间 形式 zx =h(x,, v,, 上) ， 式 中 ,vy 是 已 知 
概率 密度 为 P(v,) 的 独立 噪声 序列 。 观 测 步 又 实现 
如 下 。 进 行 一 次 观测 z, =z,。 对 每 一 个 支撑 值 x;， 概 
率 计算 为 


A(xi) =P(z, =z, | x, 2 xi) (25.51) 
实际 上 ， 这 要 求 观测 模型 采用 一 种 等 同 的 形式 ( 比 
如 高 斯 ) ， 从 而 允许 测量 得 到 的 z, 和 被 每 一 个 粒子 
h(x, ,， 上) 预测 的 观测 值 之 间 误 差 的 概率 得 到 计算 。 
观测 后 更 新 的 权 数 是 
wi wi ,P(z, =z, | xi) 

3. 重新 采样 

在 权 数 更 新 之 后 ， 通 常 对 测量 xi, wi] ,进行 
新 采样 。 重 新 采样 集中 在 具有 更 大 概率 密度 的 区 
。 重 新 采样 决定 的 做 出 是 基于 有 效 数量 , 即 Ns 个 
采样 中 的 粒子 ， 其 值 大 约 由 Ns = 1/ 之 (wi) 估算 
而 来 。 采 样 重要 性 重新 采样 算法 (SIR) 在 每 一 次 循 
环 进行 重新 采样 ， 这 样 权 数 总 是 相等 的 。 重 新 采样 的 
一 个 关键 问题 是 采样 集 固定 在 一 些 较 大 可 能 性 的 采样 
上 。 在 重新 采样 中 这 样 可 能 造成 的 问题 称 为 采样 贫 
化 。 一 般 上 ， 当 Ns 小 于 实际 采样 数 的 某 个 分 数 ( 比 
如 1/2) 的 时 候 ， 最 好 重新 进行 采样 。 

4. 使 用 蒙特 卡 罗 方 法 的 时 机 

蒙特 卡 罗 法 (MC) 特别 适用 于 状态 转变 模型 和 
观测 模型 高 度 非 线 性 化 的 问题 。 这 是 因为 基于 采样 的 
方法 可 以 描述 非常 普遍 的 概率 分 布 。 特 别 是 多 模型 或 
多 重 假设 密度 方程 ， 都 能 很 好 地 被 蒙特 卡 罗 法 处 理 。 
但 是 ， 特 别 要 注意 的 是 在 所 有 情况 下 ， 模 型 P(x 
|x) 和 P(z |x,) 必须 是 可 列举 的 ， 而 且 必 须 是 


(25.52) 
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基于 参数 和 基于 栅 格 的 数据 融合 方法 之 间 的 缺口 。 
蒙特 卡 罗 法 不 适用 于 状态 空间 维 数 很 高 的 问题 。 
一 般 而 言 ， 对 一 个 给 定 的 概率 密度 进行 如 实地 建 模 需 
要 的 采样 数 随 状态 空间 的 维 数 呈 指数 增加 。 有 一 种 办 
法 可 以 限制 状态 空间 的 维 数 ， 采 用 的 方法 是 将 不 需 
使 用 采样 进行 建 模 的 部 分 状态 边缘 化 ， 这 种 方法 称 为 


Rao- Blackwellization 。 
25.1.5 概率 的 替代 法 

对 信息 融合 问题 来 说 ， 不 确定 性 的 表示 法 是 如 此 
的 重要 ， 以 至 于 人 们 提出 一 些 蔡 代 建 模 技 术 来 处 理 概 


率 性 方法 中 观察 到 的 局 限 性 。 
概率 性 方法 中 观察 到 的 局 限 性 主要 有 四 个 。 


1) 复杂 性 : 要 正确 应 用 概率 性 归纳 法 ， 需 要 指 
定 很 大 数量 的 概率 。 


2) 不 一 致 性 : 在 以 概率 的 形式 指定 一 组 一 致 的 
可 信和 度 并 使 用 此 可 信和 度 对 兴趣 状态 进行 一 致 的 推导 中 
存在 的 困难 。 
3) 模型 的 精确 性 : 
其 少 的 量 的 概率 。 
4) 不 确定 因素 的 不 确定 性 : 面临 不 确定 因素 时 
指定 概率 的 难度 或 对 信息 源 的 忽略 。 
三 种 方法 可 以 解决 这 些 难 题 : 间隔 微 积 分 法 、 模 
糊 逻 辑 和 证 据 理论 (Dempster- Shafer 法 ) 。 我 们 依次 
进行 简要 介绍 。 
l. 间隔 微 积分 法 
使 用 间隔 表示 不 确定 性 来 限定 真正 参数 的 值 ， 比 
概率 性 方法 具有 几 点 潜在 的 优势 。 特 别 是 ， 当 缺乏 概 
率 性 信息 但 是 传感器 和 参数 的 误差 确定 需要 限定 时 ， 
间隔 提供 了 对 不 确定 性 的 很 好 测量 。 间 隔 法 里 ， 一 个 
参数 x 的 不 确定 性 用 一 个 声明 进行 简单 的 描述 。 此 声 
明 是 状态 x 的 真实 值 , 在 a 之 上 , 5 之 下 , 即 x ela, b], 
重要 的 是 没有 其 他 任何 概率 性 结构 的 暗示 ， 特 别 是 > 
e [a, b] 并 不 意味 着 x 在 区 间 [a, b] 内 的 分 布 
是 等 正比 的 (平均 分 布 )。 
对 间隔 误差 有 一 些 简 单 而 基础 的 操作 规律 。 这 些 
在 Moore 的 书 里 有 详细 的 描述 (他 的 分 析 原 先 
是 为 了 理解 计算 机 算术 的 有 限 精 度 )。 简 单 地 说 ， 有 
a, b, c, deR ， 加 减 乘除 分 别 由 下 列 运 算 关 系 定义 
[a, bj +[c, d] =[a+c, b+d] 
[a, b] -[e, d] =[a-c, b-d] (25.53) 
[a, b] x[c, d] 2 [min(ac, ad, bc, bd), 
max(ac, ad, bc, bd) | (25. 54) 


需要 精确 地 指定 对 某 些 知之 
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1 
>=], Og[c, d] 
[4 


(25.55) 

可 见 间隔 的 加 和 乘 都 满足 结合 律 和 交换 律 。 间 隔 算 法 
承认 一 种 明显 米 制 的 距离 测量 : 

d([a, b], [c, d]) =max( |a-c]|, |b-d|) 

(25. 56) 

使 用 间隔 的 矩阵 运算 也 是 可 行 的 ， 但 本 质 上 很 复杂 ， 
特别 是 当 要 求 矩 阵 的 逆 的 时 候 。 

间隔 微 积分 法 有 时 候 用 以 检定 ， 但 通常 不 用 于 处 
理 数据 融合 问题 ， 这 是 因为 : 

1) 很 难 用 它 得 到 收敛 于 任何 值 的 结果 。 

2) 很 难 用 它 编码 不 同 变量 之 间 的 依附 关系 ， 而 
这 恰恰 是 很 多 数据 融合 问题 的 核心 所 在 。 

2. 模糊 逻辑 

作为 一 种 表述 不 确定 性 的 方法 ,模糊 逻辑 应 用 广 
泛 ， 特 别 是 在 诸如 监督 控制 和 高 级 别 的 数据 融合 任务 
里 面 。 人 们 常常 把 模糊 逻辑 称 为 不 确定 推导 的 理想 工 
具 ， 特 别 是 在 基于 定律 系统 里 。 毋 庸 置疑 的 是 ， 模 糊 
逻辑 在 实际 应 用 中 有 一 些 显著 的 成 功 案例 。 

有 关 模 糊 集 和 模糊 逻辑 的 著作 很 多 (例如 ， 参 
见 参考 文献 【25. 14] 和 参考 文献 [25. 15] 中 第 11 
章 的 讨论 ) 。 在 这 里 我 们 简要 描述 主要 的 定义 和 操 
作 ， 而 忽略 模糊 逻辑 方法 更 高 深 的 特性 。 

考虑 一 个 通用 集 包 含 元 素 v: KX = |x|。 假 设 一 
PAN TRA Cx 使 得 

A = ix |x 具有 某 些 特性 | 

在 传统 的 逻辑 系统 里 ， 我 们 定义 一 个 成 员 函 数 A (2) 
(也 称 为 特征 函数 ) ， 它 报告 是 否 一 个 特别 的 元 素 * e 
% 是 这 个 集 的 一 个 成 员 : 


alo 


1 xeA 
0 xe&A 
比如 X 可 能 是 所 有 飞机 构成 的 集 。. 台 可 能 是 所 有 超 
音速 飞机 构成 的 集 。 在 模糊 逻辑 文献 里 ， 这 称 为 明确 
(crisp) 集 。 对 比 之 下 ， 一 个 模糊 集 是 其 中 有 一 个 成 
员 的 度 的 集 ， 度 的 范围 是 0 和 1 之 间 。 一 个 模糊 成 员 
itil PRP uu (x) 定义 了 一 个 xe x 的 元 素 对 集 .加 的 成 
员 的 度 。 比 如 ， 还 是 假设 x 可 能 是 所 有 飞机 构成 的 集 
而 .将 可 能 是 所 有 高 速 飞机 构成 的 集 。 那 么 模糊 成 员 
函数 (x) 给 每 一 架 飞 机 * 赋 一 个 0 到 1 之 间 的 值 ， 
作为 对 此 集成 员 的 度 。 形 式 上 
=p, («) [0,1] 
模糊 集 的 构成 规律 跟随 标准 明确 集 的 构成 过 程 ， 


A= -| 


比如 


76 0.8 — yng (%) =minLAw (x), us(x) J 


A US puo (2) = marly (2) , i (2) ] 
与 二 进 制 逻 辑 相 关 的 标准 属性 现在 都 起 作用 : 交换 
律 、 结 合 律 、 突 等 性 、 分 配 律 、De Morgan 定律 和 合 
并 性 。 唯 一 的 例外 是 排 中 律 不 再 工作 : 

EX 
ANAP 

所 有 这 些 定 义 和 定 律 构 成 了 推理 不 准确 值 的 系统 
方法 。 

模糊 集 理 论 和 概率 论 之 间 的 关系 仍 是 研究 界 辩 论 
的 热点 。 

3. 证 据 推理 

证 据 推理 〈 常 根据 此 理论 的 创始 人 而 称 为 Demp- 
ster- Shafer 证 据 理 论 ) 已 经 有 一 些 断 断 续 续 的 成 功 ， 
尤其 是 在 自动 推导 应 用 里 。 证 据 推理 与 概率 性 方法 和 
模糊 逻辑 法 从 定性 上 讲 都 不 大 相同 。 不 同 点 如 下 所 
述 。 考 虑 一 个 通用 集 x 。 在 概率 性 方法 或 模糊 逻辑 理 
论 里 ， 一 个 可 信和 度 可 以 赋 给 任何 元 素 x; e X 而 对 于 任 
何 子 集 有 .名 Cx 。 在 证 据 推导 里 ， 可 信和 度 不 能 赋 给 
任何 元 素 或 子 集 ， 或 子 集 的 子 集 。 特 别 的 ， 当 概率 性 
方法 的 域 是 所 有 可 能 子 集 %x ,证 据 推 导 的 域 是 窜 
集 2*。 
举例 说 明 ， 考 虑 互相 排除 集 % = occupied (i 
de), empty ( 空 )|。 在 概率 论 里 ,我 们 可 以 给 每 一 
个 可 能 的 事件 赋 一 个 概率 值 ， 比 如 ，P(occupied) = 
0.3， 而 P(empty) =0.7。 在 证 据 推导 里 ， 我 们 构建 
包含 所 有 子 集 的 集 

2* = | | occupied, empty} , | occupied} , | empty} ,中 | 
然后 给 此 集中 的 每 一 个 元 素 赋 可 信和 度 
m( | occupied, empty} ) 20.5 


m( | occupied] ) 20.3 
m( | empty} ) 20.2 
m(o) =0.0 
(IE p WIRT ARE 0 以 保证 标准 化 ) 。 这 种 赋值 
的 解释 是 ， 占 据 的 可 能 性 是 30%, 空 的 可 能 性 是 
20% ， 而 或 占据 或 空 的 可 能 性 是 50% 。 实 际 上 ， 赋 了 予 
子 集 或 占据 或 空 的 值 是 一 种 对 未 知 状态 的 赋值 或 不 能 
区 分 这 两 种 情形 的 赋值 。 参 见 参考 文献 【25. 16 ] ， 
读者 可 以 找到 一 个 详细 讨论 的 例子 ， 该 例 讨 论 如 何 将 
证 据 方法 应 用 于 确定 性 网 格 导航 。 
证 据 推 导 因 此 提供 了 一 种 捕捉 未 知 状态 或 不 能 区 
分 占据 和 空 的 方法 。 在 概率 论 里 ， 这 将 使 用 一 种 截然 
不 同 的 方式 处 理 ， 方 法 是 给 每 一 种 蔡 代 性 赋予 相同 或 
均匀 的 概率 。 但 是 ， 声 明 占 据 的 可 能 性 是 50% 与 声 
明 不 知道 它 是 否 是 占据 的 ， 这 两 种 说 法 是 明显 不 同 
的 。 这 种 使 用 寡 集 作为 识别 框架 允许 可 能 性 更 丰富 的 
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表述 。 但 是 ， 付 出 的 代价 是 复杂 性 的 显著 增加 。 如 明 
最 初 的 集 % 里 有 个 元 素 ， 那么 就 有 2” 个 可 能 的 子 集 
需要 赋予 可 信和 度 。 对 很 大 的 n 来 说 ， 显然 这 是 不 可 解 
的 。 男 外 ， 当 集 是 连续 的 时 候 ， 集 的 所 有 子 集 甚至 不 
能 被 测量 。 

证 据 推导 方法 提供 了 一 种 给 集 赋 予 和 融合 可 信 度 
的 办 法 。 也 有 其 他 办 法 获得 相关 测量 ， 称 为 支持 度 和 
可 行 度 ， 其 实 ， 就 是 Dempster 的 原始 方法 里 的 上 下 
概率 限 。 

证 据 推 导 在 离散 数据 融合 系统 起 重要 的 作用 ， 尤 
其 是 这 种 属性 融合 和 情境 检测 等 信息 未 知 或 模棱两可 
的 领域 。 使 用 它 作用 于 低 水 平 的 数据 融合 问题 具有 挑 
战 性 ， 因 为 给 需 集 赋予 可 信 度 与 状态 的 集 的 势 呈 指数 
性 关联 。 


25.2 ”多 传感器 融合 架构 
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上 节 讨 论 的 多 传感器 融合 方法 提供 了 算法 ， 使 
得 传感器 数据 及 与 它们 相连 的 不 确定 性 模型 可 以 用 
来 构建 关于 环境 的 隐 式 或 显示 的 模型 。 但 是 ， 一 个 
多 传 感 天 融合 系统 必须 包含 其 他 需要 的 功能 性 元 件 
来 管理 和 控制 融合 过 程 。 这 些 内 容 被 称 为 多 传 感 带 


融合 架构 。 


25. 2.1 


架构 分 类 学 


多 传感器 系统 的 结构 可 以 由 多 种 方式 进行 组 
织 。 基 于 实验 室 联合 主管 (JDL) 模型 是 军 方 为 多 
传感器 系统 开发 出 的 一 种 功能 性 结构 的 规划 。 这 
种 方法 视 多 传感器 融合 为 信 叶 、 特 征 、 线 程 和 情 
境 分 析 层 (所谓 JDL 层 )。 对 此 类 系统 的 检验 是 使 
用 诸如 追踪 性 能 、 存 活 率 、 效 率 和 带宽 等 条 款 的 。 
这 些 测量 值 一 般 对 机 器 人 应 用 并 不 适用 ， 因 而 JDL 
模型 在 这 儿 不 做 深入 讨论 (更 多 细节 见 参 考 文献 
[25.17，18] ) 。 其 他 分 类 方案 区 分 低级 和 高 级 融 
合 喇 21 ， 或 区 分 集中 和 分 散 式 处 理 ， 或 区 分 数据 
TUAE E01, 

XT FL dE A RAR, Makarenko U^?" B 
经 开发 出 了 一 种 一 般 性 的 结构 框图 。 我 们 的 讨论 就 基 
于 此 方法 。 下 面 定义 一 个 系统 的 架构 。 

(1) 元 架构 一 组 强烈 表述 系统 结构 特征 的 高 
级 考量 。 系 统 元 素 的 选择 与 组 织 经 由 审美 学 、 效 率 或 
其 他 设计 原则 和 目标 (比如 系统 和 元 件 的 合理 性 、 
模块 性 、 扩 展 性 、 可 移植 性 、 互 用 性 、 集 中 /分 散 化 、 
和 鲁 棒 性 和 容错 性 ) 进行 引导 。 

(2) 算法 架构 一 组 特殊 的 信息 融合 和 决策 方 
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法 。 这 些 方法 解决 的 问题 包括 数据 的 异 构 性 、 登 记 、 
校正 、 一 臻 性、 信息 含量 、 独 立 性 、 时 间 间 隔 和 上 比 
例 ， 以 及 模型 与 不 确定 性 之 间 的 关系 。 

(3) 概念 架构 “粒度 和 元 件 的 功能 
将 算法 元 素 映 射 到 功能 架构 上 )。 

(4) 逻辑 架构 “详细 而 规范 的 元 件 类 型 ( 即 面 
向 对 象 的 标准 ) 和 界面 ， 以 使 元 件 间 的 服务 正式 化 。 
元 件 可 能 是 特别 的 或 编组 的 或 其 他 考量 ， 包 括 粒 度 、 
模块 化 、 重 复 使 用 性 、 证 实 、 数 据 结构 、 语 义学 等 。 
通信 问题 包括 分 层 制 的 对 异 构 制 的 组 织 、 共 享 内 存 对 
信息 传递 、 基 于 信息 的 子 元 件 交 互 特征 、 拉 / 推 机 制 
和 订购 一 广播 机 制 等 。 控 制 牵涉 多 传感器 融合 系统 内 
的 运行 系统 的 控制 ， 和 信息 要 求 与 系统 内 的 散发 ， 以 
及 任何 外 部 的 控制 决策 与 命令 。 

(5) 执行 架构 ”定义 了 元 件 到 执行 元 素 的 映 
Bb. 这 包括 确保 程序 正确 性 的 内 部 和 外 部 方法 
( 即 ， 环 境 和 传感器 的 模型 已 经 从 数学 或 其 他 正式 
的 描述 方式 正确 地 转化 为 计算 机 程序 ) ， 和 模型 的 
验证 ( 即 ， 确 保 正式 的 描述 方式 将 物理 现实 与 要 求 
的 程度 匹配 ) 。 

在 任何 闭环 控制 系统 里 ， 传 感 器 用 以 提供 描述 当 
前 系统 的 状态 和 它 的 不 确定 性 因素 的 反馈 信息 。 为 了 
一 个 给 定 应 用 建立 一 个 传感器 系统 ， 是 一 个 系统 工程 
过 程 ， 并 包括 了 系统 要 求 的 分 析 、 环 境 模型 、 系 统 处 
于 不 同 条 件 下 的 行为 决定 和 合适 传感器 的 选择 |。 
建立 传感器 系统 的 下 个 步骤 是 整合 硬件 元 件 并 开发 必 
要 的 软件 模块 以 进行 数据 融合 与 解释 。 最 后 是 系统 测 
试 和 性 能 分 析 。 一 旦 系统 建造 完毕 ， 有 必要 对 系统 的 
不 同 元 件 进行 监视 以 进行 测试 、 调 试 和 分 析 。 系 统 也 
要 求 对 时 间 复 杂 性 、 空 间 复杂 性 、 鲁 棒 性 和 效率 进行 
定量 测量 。 

另外 ， 设 计 与 实现 实时 系统 变 得 越 来 越 复杂 ， 因 
为 增加 了 许多 特征 ， 比 如 用 户 图 形 接口 (GUI), "T 
视 功 能 和 多 种 不 同 种 类 的 传感器 。 因 而 ， 许 多 软件 工 
程 的 问题 受到 了 系统 开发 者 更 多 的 关注 ， 这 些 问 题 包 
括 可 重复 使 用 性 、 现 有 商业 (COTS) 构件 的 使 
用 1、 实时 性 1、 传感器 选择 *” AY Ae 
qEUST90 Jig A SOM AUS A 
每 一 个 不 同 的 传感器 种 类 都 有 不 同 的 特征 和 功能 


特别 是 ， 


说 明 。 因 此 ， 有 一 些 途径 致力 于 使 用 独立 于 具体 的 传 
感 器 而 开发 一 些 对 传感器 系统 建 模 的 方法 。 结 果 ， 这 
使 得 使 用 一 般 性 方法 来 研究 多 传感器 系统 的 性 能 和 重 


棱 性 变 得 可 能 。 已 经 有 很 多 种 尝试 去 提供 一 般 性 的 方 
法 ， 并 附带 具有 数学 基础 和 描述 的 尝试 。 一 些 建 模 的 
方法 关注 多 传 感 髓 系统 的 误差 分 析 和 容错 性 7。 
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其 他 的 技术 是 基于 模型 的 ， 需 要 被 感知 物体 和 环境 的 
先 验 知识 中 。 这 些 方法 帮助 数据 与 模型 匹配 ， 
但 不 能 始终 提供 比较 替代 性 模型 的 办 法 。 巾 任务 指引 
的 传 感 是 设计 传 感 策略 的 另 一 种 途径 天 OT 。 一 般 
性 的 传感器 建 模 工 作对 多 传感器 融合 架构 的 进展 已 经 
有 了 显著 的 影响 。 

另 一 种 对 传感器 系统 建 模 的 途径 是 定义 传 感 一 计 
算 系统 ， 使 之 与 每 一 个 传感器 相连 以 允许 任何 传 感 系 
统 的 设计 、 比 较 、 变 形 和 推导 扩 ” 。 在 这 种 途径 里 ， 
人 们 使 用 了 一 种 信息 不 变 的 概念 以 定义 信息 复杂 性 的 
度量 。 这 就 提供 了 一 个 计算 理论 允许 传 感 系统 的 分 
析 、 比 较 和 推导 。 

总 而 言 之 ， 多 传感器 融合 


架构 的 分 类 可 以 沿 着 四 


种 独立 的 设计 方向 选择 : 
1) 统一 一 分 散 。 


2) 构件 的 局 部 一 全 局 交互 。 

3) 模块 一 整体 。 

4) 分 层 一 异 构 。 

最 盛行 的 组 合 是 

1) 统一 、 局 部 2 交互 和 分 层 制 。 
2) 离散 、 全 局 交互 和 异 构 结 构 。 
3) 离散 、 局 部 交互 和 分 层 制 。 
4) 离散 、 局 部 交互 和 异 构 结构 。 


统 是 分 散 式 野外 机 器 人 结构 (DERA) P771, xx Zi 
统 是 传感器 融合 效果 (SFX) 结构 (的 一 般 性 总 
结 。 通 过 使 用 诸如 Java, Jini 和 XML 语言 、 容 错 性 、 
适应 性 、 长 期 性 、 界 面 一 致 性 和 动态 元 件 等 ， 这 种 途 
径 使 用 模块 ， 致 力 于 取得 基于 动作 和 慎重 的 行动 、 重 
新 配置 性 和 相互 配合 性 。 这 种 算法 结构 基于 模糊 逻辑 
控制 器 。 有 些 实验 已 经 在 室外 移动 机 器 人 的 导航 方面 
进行 了 。 
其 他 此 类 的 相似 结构 包括 感知 和 行动 网 络 ， 
Lee!) Mj Draper?" 致力 于 需要 执行 任务 ( 较 高 
层次 的 融合 ) 的 信息 种 类 ， 参 见 参考 文献 [25.52]. 

另 一 种 此 类 的 传感器 融合 途径 是 使 用 人 工 神经 网 
络 。 此 类 方法 的 优势 ， 至 少 理论 上 来 说 ， 是 用 户 不 需 
要 理解 传感器 模式 是 如 何 相 关 的 ， 也 不 需要 对 不 确定 
性 进行 建 模 ， 也 不 需要 实际 决定 系统 的 结构 ， 而 只 需 
确定 网 络 的 层 数 及 每 层 的 节点 数 。 神 经 网 络 是 使 用 一 
系列 训练 例子 表示 的 ， 而 且 必 须 通 过 神经 元 之 间 联 系 
的 权重 决定 从 输入 到 想 要 的 输出 (分 屋 、 控 制 信号 
等 ) 的 最 佳 匹配 (二 3541 。 

其 他 不 同 的 方法 也 是 存在 的 。 比 如 ，Ha- 
gert*? 引 在 贝 叶 斯 决策 理论 的 基础 上 定义 了 一 种 面 
向 任务 的 途径 进行 传感器 融合 ， 并 开发 了 一 个 面向 对 
象 的 编程 架构 。Joshi 和 Sanderson ^! 3 xk T — 4 


在 一 些 情况 下 明确 的 模块 性 也 是 符号 人 们 需要 
的 。 大 多 数 现存 的 多 传 感 咒 架构 相当 合理 地 与 其 中 的 
一 种 分 类 组 合 相 符合 。 这 些 分 类 组 合 不 是 对 算法 结构 
的 一 般 性 保证 。 如 果 算 法 结构 是 一 个 系统 的 主导 特 
征 ， 那 么 它 可 以 按照 第 25.1 节 里 的 一 些 多 传感器 融 
合理 论 进行 总 结 ; 否则 ， 它 和 这 四 种 分 类 组 合 其 中 之 
一 的 方法 仅仅 存在 些许 的 差异 。 


、 局 部 交互 和 分 层 制 


统一 、 局 部 交互 和 分 层 的 架构 包括 了 一 系列 系统 
哲学 。 代 表 性 最 小 的 是 Braitenberg 7) i /g 38 uii H 
Brooks'“” ”| 推广 的 包容 结构 。 包 容 式 多 传感器 结构 将 
动作 定义 为 基本 元 件 ， 并 使 用 一 系列 分 层 的 动作 表 : 
为 一 个 程序 (整体 ) 。 任 何 动作 可 以 使 用 其 他 动作 的 
输出 ， 也 可 以 限制 其 他 动作 。 等 级 由 层次 定义 ， 尽 管 
这 不 总 是 很 清晰 。 主 要 的 设计 原则 是 直接 由 感知 一 行 
循环 开发 行为 模式 ， 而 不 是 求助 于 不 友好 的 环境 表 
示 。 这 导致 了 操作 的 鲁 棒 性 ,但 是 缺乏 动作 的 可 预 
测 性 。 

另 一 种 更 复杂 (更 具 代 表 性 ) 的 基于 动作 的 系 


25.2.2 统一 


M 


rat 


O ”原文 错误 。 一 一 译 者 注 


“方法 来 解决 模型 选择 和 多 传感器 融合 的 问题 ， 使 用 
表示 尺寸 (描述 长 度 ) 以 选择 中 模型 类 型 和 参数 数 
量 ; @ 模 型 参数 精度 ; @@ 需 要 建 模 的 被 观测 特征 子 
集 ; @ 匹 配 特 征 与 模型 的 对 应 关系 。” 

他 们 的 途径 不 仅仅 是 一 个 结构 ， 而 且 用 了 一 个 最 
小 化 原则 以 合成 一 个 多 传感器 融合 系统 去 解决 特定 的 
二 维和 三 维 物体 辨识 问题 。 


25.2.3 ”离散 、 全 局 交互 和 异 构 结构 


离散 、 全 局 交互 的 元 结构 的 主要 例子 是 黑板 系 
统 。 很 多 黑板 系统 的 例子 已 经 应 用 于 数据 融合 问题 。 
例如 ， 由 Cehrfaoui 和 Vachon 559 F KAY SEPIA 系统 ， 
以 模块 化 中 介 的 形式 使 用 逻辑 传感器 将 结果 贴 在 一 个 
黑板 上 。 黑 板 的 整体 结构 目标 包括 有 效 合 作 和 动态 配 
置 。 文 献 指出 有 实验 进行 室内 机 器 人 在 房间 之 间 的 
移动 。 

MESSIE (多 专家 景象 解释 和 评估 ) 系统 ”是 
基于 多 传感器 融合 的 景象 解释 系统 。 该 系统 被 应 用 于 
远程 传 感 图 像 的 解释 中 。 一 种 有 关 多 传感器 融合 概念 
的 类 型 学 建立 起 来 ， 推 导出 了 物体 、 景 象 和 策略 的 建 


模 问 题 的 结果 。 该 多 专家 结构 总 结 了 之 前 工作 的 概 

， 考 虑 了 传感器 的 认 知 、 多 角度 感应 和 使 用 概率 论 
建 模 造 成 的 模型 和 数据 的 不 确定 性 和 不 准确 性 。 特 
别 的 ， 物 体 的 通用 模型 由 概念 独立 的 传感器 (LA 
关系 、 材 料 和 空间 环境 ) 表示 。 该 结构 中 的 三 种 专 
家 是 : 通用 专家 (景象 和 冲突 )、 语 义 物体 专家 以 
及 低层 专家 。 使 用 集成 控制 的 黑板 结构 。 被 解释 的 
景象 使 用 矩阵 指针 实现 ， 从 而 使 得 冲突 得 以 很 容易 
被 检测 出 来 。 在 景象 专家 的 控制 下 ， 冲 突 专 家 使 用 
物体 的 空间 背景 关系 解决 冲突 。 最 后 ， 该 文献 描述 
了 一 个 具有 SAR (合成 孔径 雷达 ) /SPOT 传感器 的 
解释 系统 ， 并 展示 了 一 个 有 桥 、 城 区 和 道路 检测 的 
例子 。 


25.2.4 离散 、 局 部 交互 和 分 层 制 


最 早 的 离散 、 局 部 交互 和 分 层 制 结构 的 例子 是 实 
时 控制 系统 (RCS), RCS 表现 为 智能 控制 的 认 
知 结构 ， 但 本 质 上 使 用 多 传感器 融合 进行 复杂 控制 。 
RCS 致力 于 将 任务 分 解 为 基本 组 织 原理 模块 。 其 定义 
了 一 系列 节点 ， 每 一 个 由 一 个 传感器 处 理 器 、 一 个 环 
境 模型 和 一 个 动作 发 生机 制 模块 构成 。 节 点 间 ， 一 般 
在 一 个 分 层 内 进行 通信 ， 尽 管 跨 层 通信 也 是 许可 的 。 
该 系统 支持 从 反应 行为 到 语义 网 络 的 广泛 的 算法 结 
构 。 更 重要 的 是 ,该 系统 维持 信号 、 图 像 和 地 图 ， 允 
许 符 号 表示 和 图 像 表示 的 紧密 耦合 。 该 系统 一 般 不 允 
许 动态 重新 配置 ， 但 是 维持 静态 的 模块 连通 结构 指 
标 。RCS BAI AM PLA aad T, 
其 他 的 面向 对 象 的 途径 见 参考 文献 [25.34, 60]. 

作为 一 种 早期 为 多 传感器 系统 宣扬 强烈 编程 语义 
需求 的 结构 法 ， 逻 辑 传感器 系统 (LSS) 使 用 功能 性 
(或 应 用 性 ) 语言 理论 达到 其 目标 。 

最 发 达 的 LSS 版 本 是 仪表 化 的 ILSS' 7?) 。 这 种 
LSS 方法 是 基于 Shilerat I Henderson 介绍 的 LSS' 1 。 
该 LSS 方法 的 设计 理念 是 掩盖 一 个 传感器 的 物理 本 质 
而 对 其 进行 详 述 。LSS 主要 的 目标 是 对 多 种 传感器 提 
供 的 信息 开发 一 种 一 致 而 有 效 的 表述 方法 。 这 种 表述 
法 提供 从 传感器 失败 中 恢复 的 方法 ， 并 在 增加 或 替换 
传感器 时 提供 重新 部 署 O 

作为 LSS 的 延伸 ，ILSS 包括 下 列 元 件 ( 见 图 
25.4): 

1) ILSS 名 称 : 唯一 地 标识 一 个 模块 。 

2) 输出 向 量 特征 (COV): 强烈 定义 的 输出 结 
构 ， 具 有 一 个 输出 向 量 和 零 或 多 个 输入 向 量 。 
3) dp. 某 个 模块 的 输入 命令 和 其 他 模块 的 输 


出 命令 。 


4) 选择 功能 : 选择 器 探测 一 个 故障 的 模块 并 切 
换 到 另 一 个 可 能 的 替代 模块 。 

5) ZET: 交替 产生 COV,, 的 方式， 正 是 这 
些 一 个 或 多 个 算法 的 实现 才 使 得 模块 的 主要 功能 得 以 
延续 实现 。 

6) 控制 命令 解释 器 (CCI): 模块 的 命令 解 
REA 

7) 嵌入 式 测试 : 增强 鲁 棒 性 和 提供 故障 排除 的 
自我 测试 程序 。 

8) 监视 器 : 检查 COV 有 效 性 的 模块 。 

9) 窃听 器 : 挂 在 输出 链 上 检视 COV 的 各 个 值 。 

这 些 元 件 标 识 了 系统 行为 并 提供 了 线 上 检测 和 故 
障 排除 机 制 。 另 外 ， 它 们 还 提供 了 对 系统 的 实时 性 能 
测量 。 监 视 器 是 有 效 性 检查 站 ， 它 过 滤 输 出 并 对 错误 
结果 提出 警告 。 每 一 个 监视 器 配 有 一 系列 规则 (或 
限定 ) 以 控制 COV 在 不 同 条 件 下 的 行为 。 


输入 命令 ”输出 向 量 特征 (COV) 
4 ; 

" 控制 命令 解释 器 

an 

视 

E 


i 
ra ea E: "a E 
网 网 mp, coc ee 网 a 
1 2 3 n iy 


输出 命令 ” COV 的 输入 向 量 
图 25.4 仪表 化 的 逻辑 传感器 模块 示意 图 


代入 式 测试 提供 在 线 检测 和 故障 排除 。elier 提 
一 个 传感器 处 理 模型 ， 具 有 探测 测量 误差 并 从 这 些 
误差 中 恢复 的 能 力 持 21。 此 方法 是 基于 提供 每 一 个 
系统 模块 验证 测试 以 测试 测量 数据 中 的 一 些 特征 ， 并 
验证 内 部 的 和 从 传感器 模块 算法 得 到 的 输出 数据 。 恢 
复 策 略 基于 针对 不 同 传感器 模块 的 局 域 规则 。ILSS 
采用 一 种 类 似 方法 称 为 区 域 戏 入 式 测试 。 在 该 测试 中 
每 一 个 模块 配备 一 系列 基于 该 模块 语义 定义 的 测试 。 
这 些 测试 产生 检验 模块 不 同方 面 的 输入 数据 ， 然 后 使 
用 一 系列 由 语义 定义 的 限定 和 规则 对 模块 的 输出 进行 
测试 。 这 些 测试 也 能 接收 来 自 别 的 模块 的 输入 以 测量 
一 组 模块 的 操作 。 例 子 是 一 个 墙 面 姿态 估 测 系统 ， 由 
一 个 具有 照相 机 和 声呐 传感器 的 Labmate 平台 构成 。 


L 
L 
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LSS HAR d up 3.4) 
25.2.5 离散 、 局 部 交互 和 异 构 结构 


此 种 元 结构 最 好 的 例子 是 Makarenko! S Jg gg 
散 式 数 据 融 合 开 发 的 主动 传感器 网 络 (ASN) 架构 。 
其 鲜明 特征 如 下 所 述 。 

1. 元 结构 

ASN 最 突出 的 特征 是 其 对 离散 性 、 模 块 化 和 严 
格 的 局 部 交互 (可 能 是 物理 性 或 取决 于 类 型 的 ) 的 
保证 。 因 而 ， 这 些 是 通信 过 程 。 离 散 意味 着 没有 元 件 
位 于 系统 的 操作 中 心 ， 而 通信 是 点 对 点 的 。 另 外 ， 没 
有 中 心 设 施 或 服务 (例如 ， 为 了 通信 、 命 名 和 服务 
查询 或 定时 ) 。 这 些 特征 导致 了 一 个 可 扩展 、 具 有 容 
错 性 和 易 重 新 配置 的 系统 。 

局 部 交互 意味 着 通信 和 链 的 数目 与 网 络 大 小 无 关 。 
另外 ,信息 的 数目 也 应 该 保持 不 变 。 这 导致 系统 的 可 
扩展 性 和 重新 配置 性 。 

模块 化 导致 从 接口 协议 、 重 配置 性 和 容错 性 CES 
为 错误 可 能 仅 来 自 独立 模块 ) 而 来 的 交叉 合作 性 。 

2. 算法 结构 

三 种 主要 算法 元 件 : 可 能 性 融合 、 功 能 融合 和 方 
针 选 择 。 可 能 性 融合 是 通过 相 邻 平台 之 间 的 所 有 可 能 
性 通信 实现 的 。 可 信 度 定义 为 世界 状态 空间 的 概率 
分 布 。 


功能 融合 是 把 单个 平台 的 部 分 功能 分 离 成 团队 的 
可 信 度 质量 功能 和 局 部 的 行动 和 通信 功能 。 不 好 的 一 
面 是 单个 行动 和 信息 之 间 的 可 能 性 耦合 被 忽略 了 ， 
为 行动 和 通信 的 功能 一 直 保持 局 域 性 。 

通信 和 行动 方针 根据 将 预期 值 最 大 化 选择 。 选 中 
的 方法 可 以 获得 某 个 特别 状态 的 最 大 化 ， 可 以 参见 
Manyika 和 Grocholsky Ay rgo 11-661 

3. 概念 性 结构 

该 系统 的 数据 类 型 包括 : 

1) 可 信和 度 : 当前 世界 的 可 能 性 。 

2) 计划 : 将 来 计划 的 世界 可 信和 度 。 

3) 行动 : 未 来 计划 的 动作 。 

元 件 角色 的 定义 导致 系统 的 自然 划分 。 信 息 融 
任务 是 通过 为 每 一 个 数据 类 型 定义 的 四 个 元 件 作用 
得 的 。 四 个 元 件 角色 类 型 是 : 源 、 水 池 、 融 合 器 和 
发 需 。( 注意 行动 这 种 数据 类 型 没有 融合 器 和 分 发 需 
这 两 种 元 件 角色 )。 

不 同 分 发 咒 间 的 连接 形成 了 ASN 架构 的 疹 骨 ， 
而 被 交换 的 信息 采取 的 形式 是 它们 的 局 域 可 信和 度 。 相 
似 的 考量 应 用 于 决定 决策 和 系统 配置 任务 的 元 件 
角色 。 

4. 逻辑 性 结构 

详细 的 结构 规范 取决 于 概念 性 结构 。 它 包括 六 种 
规范 的 元 件 类 型 ， 见 表 25. 1 HR 


conu 


25.1 规范 的 元 件 及 其 作用 (同一 行 里 多 个 X 意味 着 一 个 元 件 里 的 交叉 作用 关系 。 
“ 帧 ”没有 参与 信息 融合 或 决策 ， 但 是 为 定位 和 其 他 特殊 的 平台 任务 所 需要 ) 
可 信 度 计 划 行 动 
元 件 类 型 
源 融合 /分 发 水 池 源 融合 /分 发 水 池 源 融合 /分 发 水 池 
传感器 X 
节点 X X 
执行 器 X 
计划 器 X X X X 
使 用 界面 X X X X 
yi 
Makarenko 接着 描述 了 如 何 整合 元 件 和 接口 以 实 何 组 织 的 。 在 结构 水 平 上 ， 三 个 问题 得 以 解决 : TR 


现 ASN 中 问题 领域 的 应 用 例子 。 

5. 执行 结构 

执行 结构 追踪 逻辑 元 件 与 诸如 过 程 与 共享 库 的 执 
行 元 素 之 间 的 配对 。 配 置 观 点 显示 了 物理 元 件 在 物理 
系统 上 的 节点 匹配 。 源 代码 观点 介绍 了 软件 系统 是 如 


行 、 配 置 和 源 代码 组 织 。 

ASN 架构 的 实验 性 实现 已 经 证 实 了 它 足 够 灵活 
以 容纳 不 同 的 系统 拓扑 、 平 台 、 传 感 器 硬件 和 环境 表 
现 。 具 有 不 同 传感器 、 处 理 器 和 硬件 平台 的 数 个 例子 


已 经 给 出 


lo 
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25.3 应 用 


多 传感器 融合 系统 已 经 广泛 地 应 用 于 机 器 人 学 的 
各 种 问题 中 〈 参 见 本 章 的 参考 文献 ) ， 但 是 应 用 最 广 
泛 的 两 个 区 域 是 动态 系统 控制 和 环境 建 模 。 尽 管 有 重 
合 ， 可 以 将 它们 一 般 性 地 总 结 为 

1) 动态 系统 控制 : 此 问题 是 利用 合适 的 模型 和 
传 感 顺 来 控制 一 个 动态 系统 的 状态 〈 比 如 ， 工 业 机 
家 人 、 移 动机 器 人 、 自 动 驾 驶 交通 工具 和 医疗 机 器 
A) 。 通 常 此 类 系统 包含 转向 、 加 速 和 行为 选择 等 的 
实时 反馈 控制 环 路 。 除 了 状态 预测 ， 不 确定 性 的 模型 
也 是 必需 的 。 传 感 器 可 能 包括 力 / 力 矩 传 感 器 、 陀 螺 
仪 、 全 球 定位 系统 (GPS)、 里 程 仪 、 照 相机 和 距离 
探测 仪 等 。 
2) 环境 建 模 : 此 问题 是 利用 合适 的 传感器 来 构 
物理 环境 某 个 方面 的 一 个 模型 。 这 可 能 是 一 个 特 
别 的 问题 ， 比 如 杯子 ; 可 能 是 个 物理 部 分 ， 比 如 一 
张 人 脸 ; 或 是 周围 事物 的 一 大 片 部 位 ， 比 如 一 栋 建 
筑 物 的 内 部 环境 、 城 市 的 一 部 分 或 一 片 延 伸 的 遥远 
或 地 下 区 域 。 典 型 的 传感器 包括 照相 机 、 雷 达 、 三 
维 距 离 探测 仪 、 红 外 传感器 (IR), fett fe Rn A 
探 针 (CMM) 等 。 结 果 通 常 表示 为 几何 特征 (点 、 
线 、 面 )、 物 理 特征 O, AE ARE), RE 
物理 属性 。 一 部 分 问题 包括 最 佳 的 传 感 吕 位置 的 
决定 。 


ta 


25.3.1 动态 系统 控制 
EMS 视觉 系统 拓 9] 是 动态 系统 控制 领域 的 一 个 


突出 实例 。 目 标 是 为 自动 驾驶 交通 工具 开发 一 套 鲁 棒 
并 可 靠 的 观测 系统 。EMS 视觉 团队 声明 的 开发 日 
标 是 : 

1) 仅 使 用 市 场 上 现 有 的 元 件 。 

2) 多 种 物体 建 模 和 植 人 式 行 为 。 

3) 自身 状态 预测 使 用 惯性 传感器 。 

4) 周边 /中 央 帘 / 扫 视 视觉 。 

5) 认 知 和 目标 驱动 行为 。 

6) 物体 状态 追踪 。 

7) 实时 刷新 频率 25Hz。 

该 方法 自 二 十 世纪 八 十 年 代 就 在 开发 了 。 图 
25.5 显示 了 第 一 辆 在 德国 高 速 公 路 以 96km/h 行驶 了 
20km 的 完全 自动 驾驶 的 车 辆 。 

来 自 惯性 传感器 和 视觉 传感器 的 信息 综合 产生 
一 个 路 面 树 ( 见 图 25.6) 。 建 立 起 来 一 个 四 维 的 一 


图 25.5 第 一 辆 在 德国 高 速 公路 完全 自动 驾驶 的 车 辆 


般 性 的 物体 表示 法 。 表 示 的 物体 包括 物体 的 背景 认 
知 ( 比如 路 ) 、 行 为 能 力 、 物 体 状 态 和 方差 ， 以 及 
形状 和 外 表 参 数 。 图 25.7 绘 出 该 四 维 惯性 /视觉 
多 传感器 导航 系统 ， 而 图 25.8 给 出 硬件 布局 
情况 。 

总 之 ，EMS 视觉 系统 是 多 传 感 融 融合 应 用 于 动 
态 系统 控制 的 一 个 有 趣 而 强大 的 示范 。 


25.3.2  ANSERII: 离散 式 数据 融合 


设计 离散 式 数 据 融 合 (DDF) 方法 最 初 的 动机 
是 来 自 于 下 列 观察 。 该 观察 是 ， 传 统 的 卡尔 曼 滤 波 右 
数据 融合 示范 的 信息 和 规范 形式 可 以 利用 添加 来 自 观 
W (5X (25.41)) 的 信息 贡献 实现 。 因 为 这 些 (向 
EAER) 添加 是 可 交换 的 ， 更 新 或 数据 融合 过 程 
可 以 优化 地 分 布 于 一 个 传感器 网 络 中 号 1 
ANSER 本 项 目的 目标 是 建立 DDF 方法 来 处 理 来 自 观 
测 和 状态 的 非 高 斯 性 概率 ， 并 合并 来 自 包括 无 人 机 和 
地 面 交 通 工具 、 地 形 数据 库 和 人 类 操作 的 不 同 信息 源 
的 信息 。 

一 个 DDF 传感器 节点 的 数学 结构 显示 如 图 
25.9 所 示 。 该 传感器 使 用 概率 函数 的 形式 直接 建 
模 。 一 旦 使 用 一 个 观察 使 之 实例 化 ， 该 概率 函数 
就 作为 输入 进入 一 个 局 部 融合 循环 。 该 循环 实现 
了 式 (25.7) Ask (25.8) 里 的 贝 叶 斯 时 间 和 观 
测 更 新 。 网 络 节 点 累积 来 自 观测 或 者 与 网 络 中 的 
其 他 节点 通信 、 交 换 交 互信 息 (信息 增益 ) 的 概 
率 信息 5 生 2 。 交 互信 息 传输 到 并 被 网 络 的 其 他 节 
点 以 一 种 独特 的 方式 吸收 。 结 果 是 网 络 中 的 所 有 
节点 获得 了 一 个 简单 集成 的 基于 后 验 概 率 所 有 节 
点 的 观测 。 
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注视 控制 平台 的 
一 扬 弹头 和 移动 部 位 


固定 在 两 个 轴 
的 注视 控制 平台 


图 25.6 EMS 视觉 路 面 树 


最 佳 低频 惯性 状态 自我 估算 
高 频 惯性 状态 自我 估算 


惯性 测量 预测 


t/TV-cycles 


3 4 5 


图 25.7 EMS 视觉 导航 系统 
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交换 机 
以 太 网 
PE a NIMES em 
~i AE 
行为 计算 机 | | 网 关 计算 机 
链接 或 CAN 链接 


平台 子 系统 


全 到 
位 系 


预 处 理 和 
特征 提取 


图 25.9 一 个 离散 式 数据 


ANSER 系 统 包括 了 一 对 装备 红外 和 视觉 传 感 
器 的 自主 飞行 器 、 一 对 装备 视觉 和 雷达 传感器 的 无 人 
地 面 车 辆 ， 额 外 信息 来 自 几何 及 高 等 频谱 数据 库 以 及 
来 自 人 类 操作 的 信息 号 2 。 单 个 传感器 特征 的 概率 
函数 可 以 通过 一 个 半 监 控 机 器 学 习 方法 获得 ”|。 


计算 机 集成 块 


机 器 人 子 系统 


球 定 
统 


速率 传感器 
角度 传感器 


P(xi|zo.zr) 


融合 节点 的 数学 结构 


导致 的 概率 以 高 斯 混合 体 的 形式 建 模 。 每 一 个 平台 
对 被 观测 的 特征 维持 一 系列 离散 的 、 非 高 斯 的 贝 叶 
斯 滤波 器 ， 并 将 此 信息 传输 到 其 他 平台 。 网 络 的 结 


是 每 一 个 平台 维持 一 个 被 网 络 中 的 所 有 节点 观测 
和 所 有 特征 的 完整 地 图 。 同 一 特征 的 多 重 观 测 可 能 
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来 自 不 同 平台 ,对 所 有 节点 来 说 ， 导 致 了 一 个 对 该 ANSER [系统 展示 了 一 系列 贝 叶 斯 数据 融合 方 
特征 来 说 ， 精 度 不 断 提高 的 预测 。 一 个 对 应 的 离散 ” 法 的 基本 原则 ， 特 别 是 通过 概率 函数 对 传感器 合理 建 
式 概率 测量 在 图 25. 10 中 使 用 ， 以 显示 ANSERT A 模 的 需要 ， 和 以 基本 的 贝 叶 斯 方式 构建 非常 不 同 的 数 
统 的 操作 大 纲 。 据 融合 结构 的 可 能 性 。 


f g) h) i) 


图 25. 10 ANSER I 自动 化 网 络 的 大 纲 及 其 操作 
a) 空中 机 器 人 b) 地 面 机 器 人 c) 人 类 操作 d) 由 地 面 视觉 传感器 数据 中 发 现 的 前 三 维特 征 及 描述 这 些 特 征 的 混合 
模型 e) 融合 来 自 空中 机 器 人 (UAV) 、 地 面 机 器 人 (GV) 和 人 类 操作 (HO) 的 信息 得 到 的 全 局 图 像 的 一 部 分 。 每 
套 椭圆 对 应 于 一 个 特别 的 特征 ， 而 标注 代表 了 具有 最 高 概率 的 特征 身份 f) 一 棵 树 和 一 辆 红色 的 车 g) 来 自 这 两 个 特 
征 的 仅 基于 方向 角 的 视觉 观测 成 功 融合 h) 决定 位 置 i) 辨认 身份 
TE: 分 图 a) ~e) 是 主 系统 元 件 ， 分 图 d) 和 e) 是 观测 过 程 ， 分 图 f) ~i) 是 对 两 个 靠近 特征 的 连续 融合 过 程 。 注 意 用 于 
方位 测量 概率 的 混合 高 斯 模型 。 


的 进展 。 在 此 领域 的 更 多 发 展 将 记录 于 机 器 人 学 和 相 
25.4 结论 关 多 传感器 融合 和 集成 的 会 议和 期 刊 文献 里 。 建 立 在 
理论 和 由 研究 团体 进行 的 实验 的 基础 上 ， 重 棒 的 应 用 

多 传感器 数据 融合 在 过 去 的 几 十 年 里 取得 了 很 大 ”性 研究 已 经 被 投入 到 实际 应 用 中 。 现 阶段 人 们 感 兴 
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操作 与 接口 


第 4 篇 “操作 与 接口 ”分 为 两 个 部 分 : 第 一 部 
分 是 关于 操作 ， 其 中 盖 述 了 建 模 、 运 动 设计 的 构架 和 
对 物体 进行 抓 取 、 操 作 的 控制 ; 第 二 部 分 是 关于 接口 
技术 ， 其 中 处 理 了 人 与 机 器 人 之 间 的 物理 交互 问题 。 
通过 臂 一 手 协作 ， 人 类 可 以 敏捷 地 抓 取 和 操作 一 个 物 
体 。 人 类 通过 日 常 经 验 逐 渐 自 然 地 获得 一 种 对 手臂 这 
样 一 个 宛 余 系统 的 最 佳 控制 技能 。 特 别 是 手指 ， 在 体 
现 人 的 灵巧 性 上 举足轻重 。 没 有 巧妙 的 手指 ,我 们 很 
难 使 用 任何 日 常 工具 ， 比 如 铅笔 、 键 盘 、 杯 子 、 小 刀 
和 叉子 。 手 指 的 灵巧 性 源 于 主动 与 被 动 的 柔顺 性 以 及 
指 尖 的 多 重 感觉 器 官 。 如 此 人 敏捷 的 操作 能 力 使 得 我 们 
与 其 他 动物 截然 不 同 ， 因 此 ， 操 作 是 人 类 最 重要 的 功 
能 之 一 。 我 们 人 类 经 过 长 达 六 百 万 年 的 长 期 历史 进 
化 ,终于 有 了 现在 的 手指 形状 、 感 觉 器 官 和 操作 技 
能 。 而 由 于 人 类 和 机 器 人 在 驱动 、 传 感 和 机 理 方面 还 
有 着 很 大 的 差别 ， 实 现 机 器 人 像 人 类 一 样 的 敏捷 操作 
是 一 个 充满 挑战 的 课题 。 纵 观 现 有 的 机 器 人 技术 ， 我 
们 发 现 机 器 人 的 灵巧 度 还 远 不 及 人 类 。 通 过 概述 ， 我 
们 列 出 第 一 子 部 分 各 章 的 简单 提要 ， 如 下 : 

第 26 章 “ 面 向 操作 任务 的 运动 "。 这 章 通 过 运 
用 构 型 空间 形式 理论 ， 对 于 手臂 层次 上 的 特别 是 在 环 
境 中 的 操作 任务 ， 讨 论 了 生成 运动 的 算法 。 在 前 面 的 
章节 (第 6、7 章 ) 里 ， 重 点 是 机 器 人 运动 学 的 具体 
算法 技术 ， 而 这 章 将 重点 放 在 机 器 人 操作 的 具体 应 


在 一 些 人 类 无 法 进入 的 环境 里 替代 人 类 工作 。 因 此 ， 
实现 机 器 人 的 灵巧 度 成 为 未 来 机 器 人 设计 的 一 大 亮 
点 。 第 26 ~29 章 在 提高 机 器 人 的 灵巧 度 上 给 出 了 很 
好 的 提示 。 

第 4 篇 的 第 二 部 分 介绍 了 接口 技术 。 通 过 接口 技 
术 ， 人 类 以 直接 或 间接 接触 机 器 人 的 方式 控制 一 个 或 
多 个 机 器 人 。 在 此 ， 我 们 给 出 第 二 子 部 分 各 章 的 简单 
提要 ， 如 下 : 

第 30 章 “ 触 觉 学 "， 探 讨 了 能 让 操作 者 在 遥远 
或 虚拟 的 环境 中 感受 触觉 的 机 器 人 装置 。 在 触觉 装置 
设计 中 ,讨论 了 两 类 触觉 装置 一 种 是 导 纳 型 (ad- 
mittance) 触觉 装置 ， 它 能 够 传 感 操作 者 施加 的 力 ， 
然后 约束 操作 者 的 姿势 ， 使 之 与 模拟 物体 或 表面 的 合 
适 挠 度 相 匹配 。 另 一 种 是 阻抗 型 (impedance) 触觉 
装置 ， 它 能 够 传 感 操作 者 的 姿势 ， 然 后 根据 模拟 物体 
或 表面 的 计算 性 能 ， 对 操作 者 施加 一 个 方向 力 。 

第 31 章 “ 遥 操作 机 器 人 ”。 这 章 从 三 个 不 同 概 
念 的 分 类 入手 : 直接 控制 ， 用 户 通 过 主 界面 直接 控制 
所 有 的 从 动 运动 ; 共享 控制 ， 直 接 控 制 和 局 部 感官 控 
制 共同 控制 任务 的 执行 ， 监 督 控制 ， 用 户 和 从 动 装置 
通过 高 度 的 局 部 自主 性 松散 地 连接 起 来 。 这 章 还 讲述 
了 诸如 时 延 等 多 种 控制 因素 。 

第 32 章 “ 网 络 遥 操作 机 器 人 ”。 其 中 包括 三 个 


a 


用 上 。 
第 27 章 “ 接 触 环境 的 建 模 与 作业 ”， 提 供 了 基 
于 柔性 以 及 刚性 接触 的 接触 环境 建 模 。 这 一 章 准确 地 
处 理 了 刚体 接触 下 的 含 摩擦 的 运动 学 和 力学 问题 ， 引 
入 了 选择 矩阵 五 来 认识 接触 面 上 的 速度 约束 及 力 约 
束 。 这 一 章 还 运用 摩擦 极限 表面 的 概念 来 阐述 了 推动 
操作 。 
第 28 章 “ 抓 取 ”。 假 定 多 指 机 器 人 手 情况 ， 基 
于 封闭 性 讨论 了 多 种 抓 取 范例 。 抓 取 的 一 个 强 约束 条 
件 是 单 向 性 ， 所 谓 单 向 性 是 指 通过 一 个 接触 点 ， 指 尖 
只 能 推动 而 不 能 拉动 物体 ， 这 章 便 讲述 了 单 向 性 约束 
下 的 运动 学 问题 和 封闭 问题 。 
第 29 章 “ 合 作 机 械 手 ”"。 这 章 讲述 了 当 两 只 机 
械 手 牢 牢 地 抓 住 一 个 普通 物体 时 的 控制 对 策 ， 以 同时 
控制 协同 系统 的 运动 以 及 机 械 手 与 被 抓 物 之 间 的 相互 
作用 力 。 需 要 指出 的 是 ， 这 里 允许 双向 约束 ， 其 中 有 
方向 的 力 和 力矩 都 是 允许 的 。 

没有 像 人 类 一 样 的 灵巧 性 ， 未 来 的 机 器 人 就 不 能 


| 


1) 


方面 : 用 户 ， 任 何 拥 有 因特网 连接 的 人 都 可 以 成 为 月 
Pu 网 络 服务 器 ， 一 个 与 网 络 兼 容 的 服务 器 端 软件 能 
够 在 该 服务 器 上 运行 ， 机 器 人 ， 包 括 机 械 臂 式 机 器 
人 、 移 动机 器 人 或 任何 可 以 改变 自身 环境 的 装置 。 因 
特 网 是 控制 机 器 人 (一 个 或 多 个 ) 的 强 有 力 的 工具 ， 
因为 它 是 最 普及 的 通信 媒介 。 将 来 ， 我 们 将 看 到 因 特 
网 的 巨大 市 场 ， 同 时 ， 我 们 也 需要 谨慎 来 保证 安全 。 
第 33 章 “ 人 体 机 能 增强 型 外 骨骼 ”"， 通过 使 人 
穿 上 一 个 机 器 人 外 套 而 解决 了 使 人 类 力量 增强 的 辅助 
力量 系统 的 相关 课题 。 在 人 机 一 体 化 系统 中 ， 我 们 可 
以 想象 人 类 与 机 器 人 在 极限 的 状况 下 不 再 有 差别 。 以 
伯克利 下 肢 外 骨骼 (BLEEX) 为 例 ， 对 于 硬件 的 设 
计 和 控制 的 课题 进行 了 详细 介绍 。 

ANS EGER TE DLAs A (第 31 章 ) 还 是 网 络 遥 操 
作 机 器 人 (第 32 章 ) 都 维持 了 一 个 人 与 机 器 人 的 合 
适 距离 ， 但 是 触觉 (5530 章 ) 和 外 骨骼 (第 33 章 ) 
都 在 制造 一 种 机 器 人 与 人 的 直接 接触 。 主 要 的 研究 课 
题 之 一 就 是 如 何在 人 出 现 以 及 人 与 机 器 人 之 间 存 在 延 
迟 时 使 之 获得 一 个 合适 的 系统 控制 性 能 。 
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本 章 作为 第 4 篇 的 导论 ， 绿 述 了 机 器 人 操作 任 
务 的 生成 运动 和 控制 策略 。 介 绍 了 从 概念 、 高 层 任 
务 描述 、 到 任务 执行 层 精细 反馈 的 各 种 自动 控制 。 
阐述 了 不 同时 间 尺 度 运 动 下 的 机 器 人 和 环境 之 间接 
O (interface) 的 建 模 ， 传 感 和 反馈 等 重要 问题 。 
操作 规划 可 视 为 基本 运动 规划 问题 的 扩展 ， 可 建 模 
为 一 种 在 环境 中 抓 取 和 移动 物体 的 动作 所 生成 的 连 
续 构 型 空间 (configuration spaces) 的 混杂 系统 。 以 
装配 运动 为 例 ， 分 析 了 其 接触 状态 和 柔顺 运动 控制 
(compliant motion control)。 最 后 ， 总 结 了 集成 状态 
反馈 控制 的 全 局 规划 方法 。 
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26.1 概述 


本 手册 的 第 4 篇 关注 连接 机 器 人 和 环境 的 接口 问 
题 。 我 们 将 接口 分 为 三 类 ， 如 图 26.1 所 示 。 第 一 类 
接口 ， 在 机 器 人 和 计算 机 之 间 ， 主 要 关注 执行 任务 的 
运动 的 自动 生成 问题 。 第 二 类 接口 ， 关 注 机 器 人 和 环 
境 的 物理 交互 。 本 章 由 操作 任务 将 这 两 类 接口 联系 起 
来 ， 重 点 介绍 如 下 内 容 : 在 一 定 物理 环境 约束 下 ， 为 
满足 任务 目标 的 机 械 手 或 被 操作 物体 的 自动 规范 
(specification) ， 规 划 和 运动 执行 。 第 27 ~ 29 iB YR 
与 第 二 类 接口 相关 的 其 他 重要 问题 ， 如 机 器 人 和 环境 
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人 机 交互 
(第 30~33 章 ) 


操作 规划 和 
控制 (第 26 章 ) 


接触 
(第 27~29 章 ) 
图 26.1 第 4 篇 概述 
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接触 的 物理 特性 ， 抓 取 ( 即 机 器 人 和 被 操作 物体 的 
交互 ) ， 以 及 合作 机 械 手 之 间 的 交互 。 第 三 类 接口 ， 
如 第 30 ~33 章 所 述 ， 存 在 于 人 和 机 器 人 之 间 ， 关 键 
问题 包括 传递 给 人 的 合适 的 传 感 信息 ， 或 允许 人 交互 
地 指定 机 器 人 要 执行 的 任务 或 运动 。 

操作 是 指 在 环境 中 移动 或 重新 布置 物体 的 过 
BE 1 。 为 执行 一 个 操作 任务 ， 机 器 人 首先 建立 与 环 
境 中 物体 的 物理 接触 ， 然 后 通过 施加 力 或 力矩 使 物体 
移动 。 被 操作 的 物体 或 大 或 小 ， 或 用 来 满足 与 操作 相 
关 的 不 同 目的 〈 如 按 开 关 ， 开 门 ， 抛 光 表 面 ) Æ 
动 装配 和 工业 操作 时 ， 被 操作 物体 通常 是 零件 
(part), zKÀmjfA T8 (end effector) 通常 指 机 械 手 的 
连 杆 ， 实 现 与 零件 接触 并 施加 力 。 末 端 执 行 器 如 此 
命名 ， 是 由 于 它 通常 是 串联 运动 链 的 末端 连 杆 。 然 
而 ,复杂 的 操作 任务 可 能 需要 在 不 同 接触 点 上 同时 
施加 多 个 力 和 力矩 ， 或 对 多 个 物体 按照 一 定 顺序 施 
加 力 。 

为 理解 执行 操作 任务 所 需要 的 生成 运动 的 难点 ， 
我 们 考虑 一 个 经 典 例子 把 一 个 轴 择 入 和 孔 中 ( 轴 孔 
装配 ) 。 移 动机 械 手 如 图 26.2 所 示 ， 接 到 指令 执行 轴 
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操作 与 接口 


图 26.2 一 个 移动 机 械 手 执行 轴 孔 装配 任务 


孔 装 配 操作 任务 。 这 是 一 类 存在 于 很 多 状况 下 的 广义 
问题 结构 ， 如 柔顺 装配 。 为 简化 任务 ， 我 们 只 考虑 传 
输 运 动 (transfer motion) ( 见 26.3 节 )， 且 假设 机 器 
人 已 经 稳定 抓 取 (UL 28 章 ) 并 保持 抓 取 状态 。 如 
果 轴 和 孔 之 间 的 间距 非常 小 ， 轴 可 能 不 容易 插入 筷 
中 ， 通 常 相互 间 产 生 接触 。 为 了 把 轴 顺 利 导 入 孔 中 ， 
机 器 人 必须 能 够 根据 轴 和 孔 之 间 的 接触 状态 进行 判断 
(JL 26.4 节 )， 选 择 一 系列 合适 的 控制 策略 ， 以 完成 
这 个 任务 。 

轴 孔 装配 的 例子 说 明了 机 器 人 的 成 功 操作 需要 处 
理 存在 不 确定 性 的 几何 体 和 接触 的 模型 。 有 很 多 不 确 
定性 ， 包 括 建 模 ， 执 行 和 传 感 。 在 存在 不 确定 性 时 的 
运动 策略 规划 ， 对 计算 提出 了 巨大 的 挑战 。 一 直 以 
来 ， 把 面向 操作 的 运动 规划 分 为 两 类 : 总 体 运 动 规划 
(gross motion planning) 和 精细 运动 规划 (fine motion 
planning) 。 前 者 涉及 在 宏观 尺度 下 的 机 械 手 运动 ， 考 
虑 全 局 运动 策略 ， 而 后 者 则 考虑 如 何 处 理 不 确定 性 以 
鲁 棒 地 完成 高 精度 的 任务 。 历 史上 这 种 分 类 的 主要 原 
因 在 于 试图 简化 不 同方 面 的 问题 以 达到 可 计算 性 。 假 
设 执 行 器 位 置 、 物 体 模型 、 和 环境 障碍 物 形状 的 不 确 
定性 有 界 ， 总 体 运 动 规划 可 以 主要 根据 几何 形状 进行 
构造 〈( 见 26.3 节 )。 当 机 器 人 或 被 操作 物体 与 环境 


相 接 触 ， 如 轴 和 孔 装 配 人 


F 务 ， 需 要 引入 精细 运动 规划 技 


为 以 及 操作 任务 、 在 不 可 预见 动态 环境 中 反应 避 障 的 
位 姿 约 束 ， 确 保 指 定 目标 点 可 达 的 全 局 运动 约束 。 由 
任务 、 执 行 任务 的 机 构 的 运动 学 、 机 构 的 执行 能 力 以 
及 环境 施加 这 些 运 动 约束 。 

为 确保 在 不 确定 性 下 满足 这 些 约 束 条 件 ， 需 
要 在 反馈 控制 回路 (第 6 章 和 第 35 章 ) 中 考虑 传 
感 信息 〈( 见 第 4 篇 : 传 感 与 感知 ) 。 在 不 同时 间 尺 
度 下 引入 与 约束 类 型 相关 的 反馈 ， 例 如 ， 对 环境 
中 的 一 个 物体 施加 恒 力 ， 则 需要 1000Hz 的 高 频 反 
馈 。 在 时 间 尺 度 的 另 一 端 ， 我 们 则 考虑 与 环境 全 
局 相关 的 变化 。 例 如 ， 由 开门 或 移动 障碍 物 引起 
的 变化 ,通常 很 缓慢 或 不 经 常 发 生 ， 对 这 些 变化 
的 反馈 仅 需 要 每 秒 几 次 即 可 。 图 26. 3 用 图 形 解 释 
了 在 操作 任务 中 与 任务 相关 的 运动 约束 排序 ， 和 
相关 的 反馈 要 求 。 


; 运动 学 反应 全 局 


反馈 [反馈 的 频率 要 求 1Hz 


1000 Hz 


图 26.3 操作 任务 中 与 任务 相关 的 运动 
约束 排序 和 相关 反馈 要 求 


本 章 关 注 面向 操作 任务 的 生成 运动 算法 。 前 面 章 
节 讨 论 了 规划 算法 (第 5 章 ) 和 控制 方法 (第 6 
章 ) 。 在 这 两 章 中 ， 主 要 关注 面向 机 器 人 运动 的 具体 
算法 ， 而 本 章 则 关注 具体 应 用 ， 即 机 器 人 操作 。 这 种 
应 用 提出 了 在 面向 操作 任务 的 运动 过 程 中 运动 约束 和 
反馈 需要 满足 的 要 求 。 而 前 面 两 章 中 讨论 的 方法 仅 涉 
及 运动 约束 的 一 个 子 集 ， 如 图 26.3 所 示 。 

本 章 首 先 在 26. 2 节 中 讨论 任务 级 控制 。 任 务 级 
控制 介绍 根据 机 器 人 机 构 与 环境 的 接触 点 ， 控 制 机 器 
人 机 构 的 技术 。 控 制 这 些 接触 点 执行 运动 以 完成 具体 


术 ， 有 效 地 考虑 接触 几何 、 力 、 摩 擦 、 和 不 确定 性 
(JIL Mason 的 书 *"， 其 给 出 了 面向 操作 任务 的 精 
细 运 动 策 略 的 综述 和 已 有 方法 ) 。 


的 操作 任务 ， 不 是 
任务 相关 的 点 ， 即 
操作 任务 期 望 运 动 


直接 控 


的 直观 方法 。 


关机 构 ， 而 是 控制 机 构 上 与 
操作 点 。 这 种 直接 控制 给 出 了 描述 


26.3 市 综述 了 操作 规划 的 构 型 空间 


EX, UK 


轴 孔 装配 例子 同时 说 明了 在 执行 操作 任务 时 运动 
受到 约束 。 这 些 约束 需要 一 直 保 持 以 成 功 完成 任务 。 


具体 约束 取决 于 操作 任务 的 类 型 ， 


可 能 包括 接触 约 


束 ， 机 械 手 和 环境 接触 点 的 位 置 和 力 约束 ， 由 机 构 及 
执行 占 性 能 产生 的 运动 学 和 动力 学 约束 ， 执 行 指定 行 


构造 成 一 个 传统 运动 规划 问题 的 方法 (第 5 E) 
些 方法 帮助 我 们 直观 地 理解 ， 如 何 根据 机 械 手 、 被 操 
作物 体 和 工作 空间 中 障碍 物 的 几何 形状 和 相关 位 置 ， 
确定 操作 构 型 空间 的 几何 和 拓扑 结构 。 众 所 周知 ， 通 
常情 况 下 可 有 近乎 无 限 种 途径 完成 操作 任务 。 因 此 ， 
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操作 规划 的 难点 在 于 开发 出 在 所 有 可 能 的 运动 中 高 效 
的 组 合 搜索 方法 。 

26. 4 节 给 出 了 面向 装配 任务 的 运动 规划 ， 其 中 
轴 孔 装配 是 一 个 典型 例子 。 主 要 介绍 受到 接触 约束 的 
运动 ， 即 柔顺 运动 。 柔 顺 运动 的 装配 策略 有 两 种 比较 
宽泛 的 分 类 ， 一 类 是 利用 特殊 的 机 构 或 控制 方法 ， 即 
被 动 柔 顺 ; 另 一 类 则 根据 接触 状态 进行 主动 推理 ， 即 
主动 柔顺 运动 。 在 主动 柔顺 控制 中 讨论 了 精细 运动 
规划 。 
任务 级 控制 和 操作 规划 方法 ， 从 不 同 侧面 以 互补 
的 方式 对 运动 进行 了 描述 。 控 制 方法 能 满足 操作 任务 
的 反馈 要 求 ， 但 无 法 应 对 实现 操作 任务 的 全 局 进展 。 
而 操作 规划 则 从 另外 一 个 方面 ， 在 上 层 对 全 局 任务 进 
行 推理 ， 但 通常 计算 量 太 大 ， 很 难 及 时 处 理 不 确定 
性 、 满 足 操作 任务 的 高 频 反馈 的 要 求 。 一 个 鲁 棒 的 熟 
练 的 机 械 手 必须 在 确保 操作 任务 实现 的 同时 ， 满 足 所 
有 反馈 的 要 求 。26.5 节 讨 论 了 面向 操作 任务 的 集成 
规划 与 控制 的 多 种 方法 。 


26.2 任务 级 控制 

为 执行 操作 任务 ， 机 器 人 必须 建立 与 环境 的 接 
触 。 通 过 接触 点 ， 机 器 人 能 够 在 物体 上 施加 力 或 力 
矩 。 通 过 控制 接触 点 的 位 置 和 速度 ， 以 及 作用 力 ， 机 
器 人 使 物体 产生 期 望 运 动 ， 实 现 操作 任务 。 这 种 任务 
的 编程 ， 是 直接 指定 接触 点 的 位 置 、 速 度 和 力 ， 而 不 
是 指定 实现 这 些 任 务 的 关节 的 位 置 和 速度 ， 因 此 ， 可 
以 很 容易 地 实现 。 

考虑 送 一 杯 水 的 任务 ， 如 图 26. 4 所 示 ， 可 以 很 
容易 地 给 出 杯子 的 运动 轨迹 。 然 而 ， 为 实现 这 个 任务 
计算 关节 空间 的 轨迹 ， 则 要 复杂 得 多 ， 可 以 通过 计算 
量 很 大 的 逆向 运动 学 实现 ( 见 1.9 节 )。 更 重要 的 
是 ， 施 加 在 杯子 运动 上 的 任务 约束 并 不 能 唯一 确定 杯 
子 的 轨迹 。 例 如 ， 杯 子 不 允许 倾斜 、 需 要 保持 铅 重 地 
送 到 目的 地 ， 而 方向 却 可 以 任意 指定 。 在 任务 级 ， 根 
据 物 体 运动 可 以 很 容易 确定 这 种 任务 约束 ， 但 很 难 用 
关节 轨迹 进行 描述 。 因 此 ， 操 作 空间 控制 是 执行 操作 
任务 的 自然 选择 。 在 26. 2. 3 节 中 ， 我 们 将 看 到 对 于 
元 余 度 机 械 手 ， 操 作 空 间 框架 会 比 关节 空间 控制 提供 
出 更 重要 的 和 更 多 的 优势 。 
任务 级 的 控制 所 获得 的 优势 ， 受 限于 机 械 手 雅 可 
比 (Jacobian) 的 计算 成 本 。 在 机 械 手 的 奇异 构 型 上 
(第 3 章 )， 很 难 计 算 机 械 手 的 雅 可 比 。 在 这 些 构 型 


”此 处 应 为 图 26.4， 而 非 原 文 的 图 26.2。 一 一 译 者 注 


上 ， 机 械 手 任务 级 的 控制 是 不 稳定 的 。 需 要 采取 特殊 
措施 防止 机 械 手 进入 这 些 构 型 中 ， 或 在 这 些 构 型 附近 
设计 特殊 的 控制 器 。 通 常情 况 下 ， 需 要 控制 机 械 手 避 
免 进入 奇异 构 型 中 。 


26.2.1 操作 空间 控制 


任务 级 控制 ,也 称 为 操作 空间 控制 4 ( 见 
6.2 节 ) ， 是 根据 操作 点 而 不 是 关节 位 置 和 速度 来 指 
定 机 器 人 的 行为 。 操 作 点 是 按照 要 求 执行 运动 或 施加 
间 定 力 以 完成 操作 任务 的 机 器 人 上 的 任意 点 。 对 于 串 
联 操 作 手 臂 ， 通 常 选择 末端 执行 器 为 操作 点 。 对 于 更 
复杂 的 机 构 ， 如 仿 人 机 器 人 ,不 仅 是 元 余 度 串 联机 
构 ， 而 且 可 以 有 多 个 操作 点 。 为 描述 操作 点 的 位 置 、 
速度 、 加 速度 、 力 和 力矩 ,通常 以 操作 点 为 原点 定义 
E 标 系 。 这 种 坐标 系 称 为 操作 坐标 系 。 根 据 任务 确定 
E 标 系 的 方向 。 然 而 ， 在 仪 考虑 操作 点 的 定位 任务 的 
青 况 下 ， 也 可 以 忽略 方向 。 在 26.2.2 节 ， 我 们 将 讨 
论 更 一 般 的 任务 ， 力 位 混合 控制 。 

首先 ， 考 虑 机 器 人 上 的 操作 点 x， 关 节 速 度 9 和 
操作 点 的 速度 x 之 间 的 关系 可 由 雅 可 比 和 矩阵 ( 见 1. 8 
W) 描述 为 


um ux 


= 


= 


$ =J (a)i (26.1) 
TERS, MEN EERE J 与 操作 点 的 位 置 ， 和 机 器 人 的 
当前 构 型 g 相关 。 为 简化 ,我们 省 略 这 些 相关 变量 
示 ， 将 上 式 表述 为 -Jq. HX (26.1) ， 我 们 可 以 
得 出 施加 在 关节 上 的 瞬 态 力矩 z， 与 施加 在 操作 点 xz 
上 的 力 和 力矩 五 之 间 的 关系 为 

T=J'(q)F, (26.2) 
EE F 描述 了 在 操作 点 x 上 要 执行 的 任务 。 如 果 任 
务 给 出 了 操作 坐标 系 下 位 置 和 方向 的 全 部 信息 ， 则 FF 
表示 为 F =(f., f fis Uns Uys uw), 其 中 /为 沿 
坐标 轴 的 力 ，u 为 绕 坐标 轴 的 力矩 SE F RRT 
和 力矩 ， 为 简化 表示 ， 将 其 描述 为 向 量 形式 )。 执 行 
这 种 操作 任务 的 机 械 手 至 少 需要 具有 6 个 自由 度 。 如 
果 任 务 没 有 给 出 FF 中 某 一 元 素 的 值 ， 可 以 将 其 去 掉 ， 
雅 可 比 矩 阵 中 相应 的 列 也 去 掉 〈( 低 于 6 个 自由 度 的 
机 械 手 可 以 用 来 完成 这 种 任务 )。 例 如 ,将 wu, 去 掉 ， 
意味 着 任务 中 对 绕 z 轴 的 方向 没有 要 求 。 去 掉 任务 空 
间 中 的 某 个 维度 ， 意 味 着 在 这 个 维度 上 机 器 人 可 自由 
摆动 、 具 有 任何 行为 。 在 26.2.3 节 中 ,我 们 将 
讨论 在 这 些 未 指定 任务 空间 的 维度 上 ， 如 何 执行 其 他 
附加 行为 。 
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同 关节 空间 控制 相似 ， 我 们 须 建立 机 械 手 在 操作 
空间 的 动力 学 ， 以 实现 在 操作 空间 中 的 控制 。 用 式 
(26. 1) ， 我 们 将 关节 空间 动力 学 投影 到 操作 空间 中 ， 
得 到 


F,=A(q) X «I(q,q)x *n(q) (26.3) 
SU, A 是 操作 空间 惯性 矩阵 ; 一 是 操作 空间 离心 力 
MIELE (Coriolis) HW; n 是 重力 补偿 项 。 这 个 公式 
和 具体 的 操作 点 相关 。 直 观 地 讲 ， 操 作 空 间 惯 性 矩阵 
A 体现 了 操作 点 对 沿 不 同 轴 的 加 速度 的 反 力 。 关 于 操 
作 空 间 控制 及 其 与 关节 空间 控制 之 间 关 系 的 更 详细 的 
介绍 ， 参 见 6.2 节 (运动 控制 ,关节 空间 和 操作 空间 
控制 ) 。 


26.2.2 ” 力 位 混合 控制 


一 旦 由 式 (26.5) 计算 出 F,， 则 可 以 通过 式 
(26.2) 吕 计算 出 用 于 控制 机 器 人 的 相应 关节 的 力矩 。 


26. 2.3 ”元 余 度 机 构 的 操作 空间 控制 


宛 余 度 机 械 手 可 以 实现 任务 级 控制 的 完全 可 达 
性 。 一 个 机 械 手 执行 操作 任务 ， 如 果 具 有 上 比 执行 任务 
需要 的 更 多 的 自由 度 ， 则 其 是 元 余 的。 例如 ， 拿 一 杯 
水 的 任务 ， 只 需要 2 个 自由 度 ， 也 就 是 在 水 平面 上 的 沿 
两 个 轴 的 旋转 运动 。 图 26. 2 所 示 的 移动 机 械 手 有 10 个 
自由 度 ， 对 于 这 个 任务 来 说 则 有 8 个 自由 度 是 宛 余 的 。 

宛 余 度 机 械 手 面向 任务 级 控制 的 操作 空间 框架 ， 
可 将 整体 运动 行为 分 解 为 两 个 部 分 。 第 一 部 分 是 由 任 
务 给 定 ， 由 作用 在 操作 点 上 的 力 和 力矩 描述 ，F,,。 
可 根据 式 (26.2) 将 这 个 向 量 五 转换 为 关节 力矩 ， 


jv 


我 们 以 轴 孔 装配 为 例 ， 假 设 轴 已 插入 孔 中 稳 
回 连接 在 机 器 人 末端 执行 器 上 。 在 轴 上 的 一 个 点 定义 
操作 坐标 系 ，z 轴 定 义 为 沿 着 轴 搬 入 孔 的 期 望 运动 方 
向 。 为 实现 这 个 任务 ， 机 器 人 控制 轴 在 操作 坐标 系 x 
轴 上 的 位 置 ， 同 时 控制 轴 和 和 孔 之 间 的 接触 力 以 避免 卡 
住 。 因 此 ， 在 孔 中 移动 轴 的 任务 需要 力 和 位 置 控 制 的 
THF 
为 描述 操作 空间 框架 下 的 接触 力 ， 我 们 将 式 
(26.3) 改写 为 
F,-F, +A(g)F, *I(q,q)x *n(q) (26.4) 
RP, F, 表示 作用 在 末端 执行 器 上 的 作用 力 '**。 
因为 x 仅 用 于 动态 解 厅 系 统 中 ， 即 单位 质量 点 的 系 
i, RITHE, RE x 。 现 在 ， 我 们 可 以 通过 选择 
如 下 控制 结构 来 控制 操作 坐标 系 下 的 力 和 运动 
F.,-F,.-«F, 


(26. 5) 
式 中 ， 
F, -A(q) QF), «I ( q,q)x +n(q) (26.6) 
F, - A(q) OF. (26. 7) 
RP, OAO 为 互补 任务 描述 矩阵 4 ， 决 定 末端 执行 
器 是 沿 着 哪个 方向 进行 位 置 控 制 和 力 控制 。 通 过 恰当 地 
选择 Q2, 位 置 和 力 控制 可 以 形成 不 同 组 合 ， 以 适应 不 同 
任务 需求 。 最 简单 形式 为 对 角 和 矩阵 ，Q =T -0Q2。 如 果 对 
末端 机 械 手 的 第 i 个 操作 坐标 进行 位 置 控 制 ， 则 .0 的 第 
i 个 对 角 输 入 为 1， 如 果 进 行 力 控制 则 为 0。 这 种 最 简单 
的 情况 ， 是 在 同一 个 坐标 系 下 进行 沿 坐标 轴 的 位 置 和 力 
控制 。 任 务 描述 甜 阵 的 概念 可 以 扩展 到 在 不 同 取 向 的 坐 
标 系 中 进行 位 置 和 力 控制 *1。 


”此 处 应 为 式 (262), ， 而 非 原文 的 〈26. 1) 。 一 一 译 者 注 


T=J'F xo 然而， 对 于 宛 余 度 机 械 手 ， 力 矩 向 量 T 并 
不 能 唯一 确定 ， 我 们 可 以 从 一 组 确保 一 致 性 任务 
(task- consistent) 的 力矩 向 量 中 进行 选择 。 操 作 空 间 
框架 考虑 选择 次 要 的 任务 ， 实 现 所 谓 的 姿态 行为 ， 构 
成 了 整体 运动 行为 的 第 二 部 分 。 姿 态 行为 可 由 任意 力 
矩 向 量 Tree 确 定 。 为 确保 附加 力矩 不 影响 任务 行为 
(Fax), EJ Tposure 投影 到 任务 雅 可 比 y 的 零 空间 
NPS, 雅 可 比 的 零 空 间 与 了 所 张 成 的 空间 正 交 ， 
FR N,-k, HB N, 是 机 械 手 的 自由 度数 ， 且 有 = 
rank(.J) 。 由 零 空 间 投影 得 到 的 力矩 NT. Towwre 能 确保 
任务 的 一 致 性 ， 即 确保 不 影响 操作 点 的 行为 。 然 而 ， 
由 于 向 量 NT Tree 不 可 能 完全 位 于 了 的 零 空间 内 ， 而 
不 能 确保 姿态 行为 的 执行 。 

操作 空间 任务 (JF) 和 姿态 行为 (N 
Tposture) 可 以 结合 起 来 实现 整体 运动 行为 在 力矩 层 的 
分 解 


T=J"F +N Tous (26.8) 
与 任务 雅 可 比 J 相关 的 零 空间 投影 N 为 
N-I-JJ (26.9) 
式 中 , 了 是 单位 矩阵 ，J iJ oA S] SX, 
J=H'S'A (26. 10) 


APF, XF J 所 定义 的 操作 点 , H ERRI 28 [aE 
REM; A 是 其 操作 空间 惯性 矩阵 。 这 种 利用 求 逆 的 方 
法 计算 零 空间 投影 的 结果 ， 可 得 到 使 动能 最 小 的 任务 
一 致 性 的 力矩 向 量 候选 解 。 


26.2.4 移动 性 和 操作 性 


操作 空间 控制 不 能 具体 给 出 哪些 自由 度 用 于 移 
动 ， 哪 些 用 于 操作 。 这 种 方法 以 末端 执行 器 为 中 心 ， 


第 26 章 面向 操作 任务 的 运动 143 


考虑 所 有 自由 度 ， 对 末端 执行 右 定 位 和 移动 。 任 务 级 
控制 的 操作 和 移动 的 明确 协调 不 是 必要 的 。 

参考 文献 [26.7] 给 出 了 一 种 高 效 地 协调 操作 
和 移动 的 方法 。 参 考 文 献 [26.8] 给 出 了 一 种 相似 
的 、 基 于 模式 (schema) 的 操作 和 移动 的 协调 方法 ， 
进行 了 动态 障碍 环境 验证 。 这 种 方法 基于 式 
(26.2) ， 将 由 不 同 模式 得 到 的 力 投影 到 机 器 人 的 构 
型 空间 中 生成 运动 。 另 一 种 操作 和 移动 的 协调 方法 考 
虑 未 端 执 行 句 的 给 定 路 径 ， 按 照 一 定 操作 度 准则 生成 
ERIE! 。 这 种 移动 机 械 手 的 底层 表达 方法 ， 也 
可 以 用 来 在 给 定 末端 执行 器 路 径 时 生成 平台 的 避 障 行 
HEN, BAH [26.11] 介绍 了 非 完 整 约束 的 移 
动机 械 手 的 协调 方法 ， 实 现 推 小 车 任务 。 人 参考 文献 
[26.12] 分 析 了 有 两 个 机 械 手 的 移动 平台 的 任务 空 
间 。 这 种 有 两 个 机 械 手 的 系统 可 以 看 做 一 个 分 支 运 动 
链 。26.6 节 讨 论 了 对 这 种 分 支 机 构 的 操作 空间 控制 
方法 。 
26.2.5 多 任务 行为 


将 元 余 度 机 器 人 的 整体 运动 行为 分 解 为 任务 和 姿 
态 行 为 ,这 种 概念 可 以 扩展 到 任意 数量 的 行 
HES, BERA n 种 任务 集合 T， 当 i < j 时 ,7 
的 优先 级 高 于 7;。 每 个 任务 T, 与 力 向 量 F, 以 及 相应 
的 关节 力矩 到 相关 。 将 与 任务 相关 的 关 闻 力矩 投影 到 
所 有 更 高 优先 级 任务 的 联合 零 空间 中 ， 则 可 以 同时 执 
行 这些 任 务 ， 就 如 上 面 所 述 的 任务 和 姿态 行为 相 结合 
一 样 。 零 空间 投影 确保 任务 i 的 执行 不 影响 更 高 优先 
级 任务 的 执行 ， 其 表示 为 集合 prec (i) 。 

给 定 任 务 i， 将 T; 投影 到 更 高 优先 级 任务 集合 
prec(i) 的 联合 零 空间 中 ， 可 以 得 到 与 prec(i) 相 一 
致 的 关节 力矩 。 


Ti | pree(i) EN wb (26. 11) 
式 中 ， 联 合 零 空间 N'., 为 
N weta -N,GN, UN, 3° (26. 12) 


SEB, Ti pree(i) 定义 为 在 上 述 任务 集合 prec. (i) ALF 
下 任务 i 的 力矩 。 把 这 个 力矩 作用 到 机 器 人 上 不 会 影 
响 更 高 优先 级 任务 的 执行 。 原 始 力矩 向 量 到 可 由 式 
(26.2) 计算 。 
如 果 可 以 计算 出 与 上 述 任务 集合 相 一 致 的 任务 力 
和 矩 ， 我 们 就 能 将 任意 数量 的 任务 组 合 为 单一 运动 
行为 ， 
T - Ti + 本 |pec(2) + T3 | pree(3) 十 … + Tn | pree(n) 
(26.13) 


式 中 ，z 是 用 来 控制 机 器 人 的 力矩 。 
注意 ， 由 于 是 最 高 优先 级 的 任务 ， 没 有 被 投 


影 到 任何 零 空间 中 。 因 此 ,任务 1 将 在 由 机 器 人 运动 
学 定义 的 整个 空间 中 执行 。 如 果 机 器 人 有 N 个 自由 
度 ， 这 个 空间 就 有 N 维 。 随 着 机 器 人 执行 任务 数量 
的 增加 ， 零 空间 投影 o 将 把 与 低 优先 级 任务 相关 
的 IN 维 力矩 向 量 投影 到 一 个 降 维 的 子 空间 中 。 
当 所 有 力矩 向 量 都 投影 到 零 向 量 上 ， 零 空间 会 被 缩减 
到 很 小 。 这 将 抑制 低 优先 级 任务 的 执行 。 任 务 集合 
prec(i) 的 零 空 间 的 维 数 可 以 通过 N esti) 的 非 零 奇异 
值 * 的 数目 确定 ， 用 来 进行 任务 可 行 性 的 方案 
评价 。 

如 果 为 确保 某 一 特定 任务 的 执行 ， 需要 将 其 与 任 
务 1 用 式 (26.13) 关联 起 来 。 因 此 ， 最 高 优先 级 任 
务 通常 作为 一 种 硬性 约束 ， 在 任何 条 件 下 都 不 能 违 
背 。 对 于 仿 人 机 器 人 ， 这 些 约束 可 以 包括 接触 约束 、 
关节 范围 、 平 衡 等 (第 56 章 ) 。 

式 (26.11) 的 投影 将 任务 i 的 力矩 Tt; 映射 到 所 
有 上 述 任务 集合 的 零 空间 中 。 这 个 投影 同时 也 调整 了 
会 主要 妨碍 任务 i 执行 的 向 量 的 级 别 。 为 了 减少 这 种 
影响 ， 可 调整 操作 点 的 期 望 加 速度 ， 即 一 至 性 任 
SEERE A, co 


mA, 


A; oss) = (Jii puto H I, "» =! (26.14) 
式 中 , 五 是 关节 空间 的 惯性 矩阵 ， 且 
J; | pree( i) =J N pet) (26. 15) 


是 与 上 述 所 有 任务 集合 相 一 致 的 任务 雅 可 比 。 这 个 雅 
可 比 将 操作 空间 的 力 转换 为 关节 力矩 ， 并 不 使 任务 集 
fi prec(i) 产生 在 操作 点 的 任何 加 速度 。 当 操作 点 的 
运动 局 限 在 与 上 述 所 有 任务 相 一 致 的 子 空间 中 时 ， 一 
致 性 任务 的 惯性 矩阵 A; pec 可 用 于 描述 操作 点 的 
惯性 。 

利用 一 致 性 任务 的 惯性 矩阵 ， 将 关节 空间 动力 学 
投影 到 .wen 的 动态 一 致 性 逆 所 定义 的 空间 中 ,我 
们 能 得 到 一 致 性 任务 的 操作 空间 动力 学 。 把 式 
(26.2) 变换 并 代入 式 (6.1) 替换 Fr， 可 以 得 到 


Je HCG) +C(g,9) +Te(q) =T, | peeti ) 
(26. 16) 
生成 与 式 (26.3) 等 价 的 一 致 性 任务 。 
F| pet) 74A; | preeti) X +T, | -— EN, ] prti 
(26.17) 
RP, A, wo 是 一 致 性 任务 的 操作 空间 惯性 矩阵 ， 


D ,描述 了 操作 空间 的 离心 力 和 科 氏 力 ， 
是 重力 补偿 项 。 可 用 式 (26. 17) ， 以 一 致 性 任务 方 
式 控 制 特定 操作 点 的 任务 ， 即 不 会 产生 与 prec(i) 中 
任务 相关 的 操作 点 的 加 速度 。 注 意 ， 实 际 上 可 以 在 关 
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节 空 间 中 计算 C(q, q) 和 天 (4g) ， 在 多 任务 行为 中 
仅 需 计算 一 次 。 

参考 图 26.3， 我 们 能 分 析 操 作 空 间 框架 的 有 效 
性 。 操 作 点 的 控制 直接 描述 了 操作 任务 运动 过 程 中 的 
力 和 位 置 约束 。 可 用 任务 优先 级 更 低 的 附属 行为 来 确 
保 运 动 学 和 动力 学 约束 ， 实 现 姿态 行为 控制 ， 或 基于 
人 工 势 场 法 实现 避 障 六 5。 所 有 这 些 方 面 的 操作 任 
务 控 制 的 计算 效率 都 很 高 。 因 此 ， 操 作 空间 框架 能 保 
持 这 些 运 动 约束 有 满足 反馈 频率 的 要 求 。 然 而 ， 操 作 
空间 框架 不 包括 全 局 运动 约束 ， 如 工作 空间 的 连通 性 
所 施加 的 约束 等 。 因 此 ， 操 作 空间 框架 与 人 工 势 场 类 
似 ， 容 易 陷 入 局 部 极 小 值 。 这 种 局 部 极 小 值 在 所 有 上 
述 运动 约束 中 都 可 能 发 生 ， 影 响 机 器 人 实现 任务 。 为 
解决 这 个 问题 ， 需 要 采用 规划 的 方法 ( 见 第 5 章 和 
26.3 节 ) 。 

参考 文献 [26.16] 介绍 了 控制 基础 方法 ， 给 出 
了 一 种 考虑 多 行为 的 简洁 蔡 代 形式 。 每 个 单独 行为 由 
一 个 控制 器 描述 ， 表 示 为 势 函数 W e D, ERA er 
e 上 5， 和 执行 器 Tr e 。 设 定 传 感 需 和 执行 器 的 参数 ， 
可 以 确定 控制 器 $6。 一 个 特定 行为 可 以 表示 为 $ | 7。 
控制 器 设计 可 与 零 空 间 投 影 结合 起 来 ， 如 式 
(26. 13)。 在 控制 基础 方法 中 式 (26. 13) 可 以 更 简 
洁 地 描述 为 


p, <1- dd; Id, «10, (26. 18) 
式 中 ,将 中 , | CAE pio d IP RR 由 投影 到 由 的 
零 空 间 中 ， 称 由 执行 上 属于 由。 如果 联合 了 两 种 以 
上 行为 ， 如 式 (26.18) 所 示 ， 则 每 个 控制 器 由 投影 
到 其 所 有 高 级 任务 的 联合 零 空间 中 。 
控制 基础 方法 表示 了 控制 器 联合 的 通用 方法 ， 旧 
并 不 局 限于 任务 级 控制 。 除 去 以 上 的 控制 器 的 联合 方 
式 ， 控 制 基础 方法 也 包括 了 离散 结构 ， 其 定义 了 联合 
控制 器 的 转换 。 这 种 转换 方式 可 由 用 户 指定 ， 或 通关 
强化 学 习 方 法 进行 学 习 %* 站。 控制 基础 方法 可 构成 
多 任务 级 控制 器 ， 实 现 不 能 由 单一 任务 级 控制 器 所 撒 
述 的 操作 任务 。 


iid 


26.3 操作 规划 


可 以 采用 数学 分 析 方法 ， 评 估 面 向 操作 的 全 局 运 
动 规划 所 固有 的 计算 难度 。 本 书 中 规划 的 章节 (第 5 
章 ) 介绍 了 构 型 空间 (C 空间 ) ， 其 代表 了 机 器 人 可 
变换 的 空间 。 一 般 情况 下 ， 所 有 可 变换 的 集合 构成 了 
一 个 nn 维 形式 (manifold)， 其 中 为 机 械 系统 的 自由 
度 的 总 数 。 对 于 一 个 机 械 手 来 说 ， 构 型 空间 可 由 其 运 


动 学 结构 来 定义 ( 见 第 1 章 ) 。 和 常见 的 一 类 机 械 手 是 
串联 机 械 手 ， 由 一 系列 转动 或 柱 形 平 动 关节 构成 ， 相 
互 连 接 形成 一 个 线性 运动 链 。 本 节 所 讨论 的 操作 规划 
是 针对 单一 运动 链 的 机 械 手 的 构 型 空间 。 然 而 ， 这 些 
数学 方法 也 可 应 用 在 更 复杂 的 机 器 人 上 ， 如 仿 人 机 器 
人 CWE 26.4, 2856 章 ) ， 其 上 身 包括 一 个 移动 平 
台 和 附着 其 上 的 两 个 合作 机 械 手 (第 29 章 ) 。 这 
里 所 采用 的 模型 极 大 地 简化 了 抓 取 、 稳 定性 、 摩 
擦 、 力 学 (Mechanics) 、 和 不 确定 性 所 产生 的 问 
题 ， 而 主要 针对 几何 形状 。 本 节 中 ,我 们 考虑 一 
种 简单 的 操作 任务 例子 ,涉及 传统 的 取 放 操作 。 
26. 4 节 进 一 步 考虑 在 装配 操作 中 的 抓 取 和 接触 状 
态 。26.5 节 综 述 了 面向 更 复杂 的 操作 任务 的 集成 
反馈 控制 和 规划 技术 。 


图 26.4 H6 仿 人 机 器 人 操作 物体 的 仿真 


26.3.1 构 型 空间 形式 


基本 的 运动 规划 问题 定义 为 在 构 型 空间 中 寻找 
一 条 连接 起 始点 到 目标 点 的 路 径 ， 同 时 需要 避免 环 
境 中 的 静态 障碍 物 ( 见 第 5 章 ) 。 操 作 规 划 则 引入 
了 更 多 的 复杂 性 ， 这 是 由 于 实现 操作 任务 需要 与 环 
境 物体 相 接触 。 当 物体 被 抓 取 、 再 次 抓 取 、 移 动 时 ， 
自由 构 型 空间 的 结构 和 拓扑 会 产生 很 大 变化 。 然 而 ， 
操作 规划 又 同时 具有 与 传统 路 径 规划 相同 的 基本 理 
论 基础 和 计算 复杂 性 ， 如 PSPACE 难度 ( 见 第 
5 章 ) 。 

更 确切 地 说 ， 我 们 所 采用 的 面向 操作 规划 的 方法 
主要 来 源 于 Aami °°! F LaValle 8-508 5! 。 我 
们 的 目的 是 获得 对 面向 操作 任务 的 搜索 空间 及 其 产生 
的 不 同 状况 的 理解 和 直观 认识 。 通 过 这 种 讨论 ,来 记 
住 工 作 空 间 中 机 械 手 、 待 操作 物体 、 障 得 物 的 几何 形 
状 和 相对 位 置 ， 是 决定 自由 构 型 空间 的 几何 形状 和 拓 
扑 机 构 的 因素 。 在 这 个 框架 下 ， 操 作 规划 可 以 直观 地 
划分 为 混杂 系统 规划 范畴 所 2 。 混 杂 系 统 指 连续 变 
量 和 离散 模 态 (modes) 的 混合 ， 模 态 的 转变 由 开关 
函数 定义 (关于 混杂 系统 规划 的 讨论 ， 见 LaValle 的 
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BOSS 7 章 ) 。 操 作 规划 时 ， 在 环境 中 抓 取 、 重 
新 定位 以 及 释放 物体 ， 都 对 应 着 不 同 连 续 构 型 空间 的 
相互 转换 。 

我 们 考虑 一 个 简单 的 拾取 操作 任务 ， 机 械 手 4 将 
一 个 可 移动 物体 (RITE) P 从 当前 位 置 移动 到 工作 
空间 中 的 某 个 期 望 目标 位 置 。 注 意 ， 完 成 这 个 任务 只 
需要 使 零件 尸 到 达 目 标 位 置 即 可 ， 而 不 必 考 虑 机 械 
手 如 何 实现 这 个 任务 。 因 为 零件 自己 不 能 移动 ， 它 只 
能 通过 机 器 人 进行 传输 ， 或 者 被 放置 在 某 个 稳定 的 中 
间 构 型 上 。 机 器 人 有 一 些 构 型 ,能够 抓 取 和 移动 零件 
到 环境 中 的 其 他 位 置 。 也 有 一 些 不 可 达 的 构 型 ,使 机 
器 人 或 零件 与 环境 中 的 障碍 物 发 生 碰撞 。 操 作 规划 问 
题 的 解 由 机 器 人 单独 运动 或 抓 持 零 件 时 和 运动 的 一 系列 
的 子路 径 构成 。 施 加 在 运动 上 的 主要 约束 包括 : 

1) 机 械 手 在 趋向 、 抓 取 、 或 再 抓 取 零件 时 不 能 
与 环境 中 的 任何 障碍 物 碰 撞 。 


2) 机 器 人 在 运输 过 


程 中 必须 稳定 抓 持 零件 〈 抓 


取 的 详细 介绍 以 及 稳定 


〖 持 的 准则 ， 见 第 28 章 ) 。 


3) 在 


零件 运输 的 过 程 9 


P, PLFA 


EH 


不 能 与 


环境 中 的 任何 障碍 物 碰 撞 。 

4) 如 果 零 件 没 有 被 机 器 人 传输 ， 它 需要 静止 地 
处 于 某 个 稳定 的 中 间 位 置 上 。 

5) 零件 最 终 被 放置 在 工作 空间 中 的 期 望 目标 位 
置 上 。 

这 个 混杂 系统 规划 有 两 种 操作 模式 一 是 机 器 人 
单独 运动 ， 一 是 机 器 人 抓 持 零件 时 运动 。 通 常情 况 
下 ， 我 们 将 机 器 人 稳定 抓 持 物体 的 运动 称 为 传输 路 径 
(transfer paths) ， 将 物体 稳定 静止 时 机 器 人 的 单独 运 
SPATE PFE (transit paths) 772027, FRYE RL Xil 
问题 的 求解 是 指 在 机 械 手 能 完成 任务 的 传输 路 径 和 过 
渡 路 径 所 构成 的 连续 序列 中 进行 搜索 。 对 于 自主 机 器 
A, 理想 情 况 是 通过 规划 算法 能 自动 生成 与 抓 取 和 非 
抓 取 操 作 相 对 应 的 传输 和 过 渡 路 径 的 准确 序列 。 

1. 容许 构 型 

在 第 5 章 介绍 的 概念 的 基础 上 ， 我 们 定义 一 个 在 
欧 拉 空间 中 及 n 个 自由 度 的 机 械 手 4，WW=RR*， 其 
HN =2 N =3。 令 C 表示 4 的 n 维 C 空间 ,gq 
是 一 个 构 型 。C* 称 为 机 械 手 的 构 型 空间 。 令 P 表示 
一 个 可 移动 的 零件 ， 是 一 个 可 由 几何 元 素描 述 的 刚性 
固体。 假设 零件 P 允许 进行 刚性 体 变形 。 相 应 地 存 
在 一 个 零件 的 构 型 空间 ，C” =SE(2) EXC" =SE(3), 
令 q eC", 表示 一 个 零件 的 构 型 。 SPY IE 
所 占据 的 工作 空间 的 区 域 或 大 小 由 P(g”) 表示。 我 
们 用 笛 卡 儿 (Cartesian) 积 定 义 联合 (Boss ARA 
件 ) 构 型 空间 C 为 


C=C'xC 
其 中 每 个 构 型 ve C 的 形式 为 9 =(q', d) HER, 
与 简单 的 Cj。( 在 有 障碍 物 环 境 中 的 所 有 避 障 空间 ， 
见 第 5 章 定义 ) 相 比 ， 用 于 操作 规划 目的 的 容许 构 型 
集 的 限制 性 更 强 。 我 们 必须 通过 删除 禁止 构 型 以 体现 
允许 运动 的 约束 。 图 26.5 给 出 了 用 于 操作 规划 的 C 
的 一 些 重要 子 集 的 例子 。 我 们 首先 删除 所 有 与 障碍 物 
碰撞 的 构 型 。 定 义 机 械 手 与 障碍 物 碰 撞 的 构 型 子 集 为 

Cin = 1(q ,gq )eClA(g) n0 D] 
我 们 也 要 删除 零件 与 障碍 物 相 碰撞 、 而 保留 零件 表面 
与 障碍 物 表 面相 接触 的 构 型 。 在 很 多 例子 中 会 出 现 这 
种 现象 ， 如 将 零件 放 在 书架 或 桌子 表面 ， 或 将 轴 形 物 
体 插入 孔 中 。 因 此 ， 令 
Cas =| (4°, ) EC lit(P(4°)) N0 D| 

FTN TELE PAY g 上， 零件 内 部 点 集合 im (PCq^)) 
与 障碍 物 集合 0 相交 的 开 集 。 很 明显 ， 需 要 避免 那 
些 零件 内 部 点 进入 到 0 中 的 构 型 。 


4 A (q^) 
A (q^) 
o P (q^) o 
q € Eos q € Ets q € Eos 
A 
A (q^) A (q^) 
P@) 
P (q^) 
P (q^) 
qe E grasp q € Estable q € E trans 


图 26. 5 用 于 操作 规划 的 不 同 构 型 空间 子 集 定义 的 例子 


现在 ， 我 们 定义 C\( Ci Ch). ， 表 示 机 器 人 和 
零件 不 与 0 发 生 不 正当 碰撞 的 所 有 构 型 集合 。 接 下 
来 ,考虑 4 和 尸 之 间 的 交互 。 人 允许 机 械 手 与 零件 表 
面 接触 ， 但 禁止 进入 零件 内 部 。 因 此 ， 定 义 零件 内 部 
与 机 器 人 外 形 相 交 的 所 有 构 型 为 

Cas =|(g ,gq ) eC|A(g ) Nint( P(g”) ) AD} 
最 后 ， 我 们 可 以 定义 

Cam = C\( Chs U Cons UC.) 
表示 除去 所 有 不 期 望 的 构 型 后 的 构 型 集 。 我 们 称 这 个 
集合 为 容许 构 型 。 

2. 稳定 和 抓 持 构 型 
由 定义 可 知 ， 在 C,,, 中 的 所 有 构 型 上 ， 机 器 人 ， 
零件 和 环境 中 的 障碍 物 都 不 会 发 生 相 互 之 间 的 进入 式 
碰撞 。 然 而 ， 在 所 定义 的 一 些 构 型 上 ， 霉 件 是 在 空间 
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中 自由 飘浮 ,或 即将 跌落 。 现 在 我 们 考虑 用 于 操作 规 
划 的 Ci 的 两 个 重要 子 集 ( 见 图 26.5)。 & Ci E 
C0" 表示 稳定 的 零件 构 型 (stable part configurations ) 
子 集 ， 在 这 些 构 型 上 ， 零件 在 没有 机 械 手 力 作用 的 情 
况 下 能 够 稳定 地 静止 。 稳 定 构 型 的 例子 包括 零件 静止 
在 桌子 上 ， 或 搬入 到 更 大 的 其 他 零件 的 装配 体 中 。 能 
人 够 进入 稳定 构 型 集合 的 条 件 与 零件 的 属性 相关 ， 包 括 
几何 形状 ， 摩擦， 质量 分 布 ， 与 环境 的 接触 等 。 我 们 
不 去 直接 考虑 这 些 影 响 ， 而 是 假设 已 有 一 些 方法 可 用 
来 评价 零件 构 型 的 稳定 性 。 已 知 Ch, 我 们 定义 
Cau E Cwm， 为 零件 和 机 器 人 系统 的 相应 的 稳定 
构 型 。 


Cae, = 1 (45,4) € Ca, 19” € Chane | 

Cum 中 的 其 他 一 些 重要 子 集 ， 是 机 器 人 抓 持 零件 、 且 
能 够 根据 某 个 定义 的 准则 进行 操作 的 所 有 构 型 集合 。 
令 Cw SC 表示 抓 持 构 型 (grasp configurations) 集 
Be EBAR (q, q) < C. 上， 机 械 手 接触 零 
件 则 意味 着 4(o) P(g?) AD. WEAR, A 
CCC ， 不 允许 机 器 人 和 有 零件 之 间 的 相互 进入。 
通常 情况 下 ， 在 许多 构 型 上 ，4(4 ) 和 P(g ) 相 接 
fil, PARED Cog, 中 。 一 个 构 型 位 于 Cong, PH 
准则 取决 于 机 械 手 ， 零 件 和 相互 之 间接 触 表面 的 特定 
属性 。 例 如 ， 一 个 典型 的 机 械 手 在 拾取 零件 时 不 会 只 
通过 一 个 点 与 零件 接触 。( 更 多 的 信息 ， 见 26. 4 WAY 
关于 接触 状态 识别 ， 第 27 章 的 抓 取 准 则 ， 第 28 章 和 
第 15 章 的 力 封闭 模型 ) 

对 任意 机 器 人 和 零件 构 型 ，g = (q^, q') eC, 
面向 操作 规划 时 ， 我 们 必须 确保 ys Cau Bk qe Cue. 
因此 ,我们 定义 Cree = Camie U Corp» RHE Cu P mi 
行 操作 规划 的 子 集 。 在 混杂 系统 中 ， 操 作 规划 有 两 种 
典型 的 模 态 : 过渡 模 态 和 传输 模 态 。 在 过 渡 模 态 中 ， 
机 械 手 不 携带 任何 零件 (RIAA BLA Ge oy), BOR 
de Cus 在 传输 模 态 中 ， 机 械 手 携带 零件 ( 即 机 器 
人 和 零件 同时 运动 ) ER qe Coss SEF RAE, 
仅 当 ge Cau N Cs， 才 会 出 现 模 态 变化 的 可 能 。 当 
机 械 手 在 这 些 构 型 上 ， 可 能 有 两 种 动作 : 中 继续 抓 持 
和 移动 零件 ，@) 在 当前 的 稳定 构 型 下 放 开 零件 。 在 所 
有 其 他 构 型 上 ， 模 态 是 不 会 变化 的 。 为 方便 ， 我 们 定 
X Crans = Cas N C ien ， 代 表 过 渡 构 型 集合 ， 在 过 渡 
构 型 中 ， 模 态 可 以 变化 ， 机 器 人 可 以 抓 持 或 放 开 
零件 


uu 


[s] 


3. 操作 规划 任务 定义 
最 后 ， 定 义 基 本 的 拾取 操作 规划 任务 。 零 件 初始 
构 型 为 di € Das ， 和 零件 目标 构 型 为 d a € diss JE 


述 的 上 层 任务 描述 只 定义 为 重新 定位 零件 ， 而 不 考虑 
机 械 手 如 何 完成 任务 。 令 Ci C5 C6， 是 零件 构 型 为 
di 的 所 有 构 型 集合 。 

C, = 19" ,9 ) © Ga eal 
同样 ， 我 们 定义 CS Cu， 是 零件 构 型 为 go 的 所 
有 构 型 集合 。 
Cul uu betes le eal 
如 果 给 出 了 机 械 手 的 初始 和 最 终 构 型 ， 则 令 qiu = 
(duas Tar) € Cus. Mga = (deus dua) € Cga HRI 


的 目的 是 计算 出 一 条 路 径 z 使 得 
T: [0,1 ]^CC. 
TCO) =q (1) = d goal 


如 果 没 有 给 出 机 械 手 的 初始 和 最 终 位 置 ， 我 们 可 以 隐 
含 地 定义 规划 器 的 目的 为 计算 出 一 条 路 径 : T: [0, 1] 
Cu ， 使 得 r(0) eC, ftir (1) eC... 无论 哪 种 情况 ， 
解 都 是 过 渡 路 径 和 传输 路 径 的 系列 ， 且 与 相应 的 模 态 
对 应 。 在 每 个 传输 路 径 之 间 ， 零 件 被 放 在 一 个 稳定 的 
中 间 构 型 上 上 ， 而 机 械 手 单独 运动 (过 渡 路 径 ) 以 重 
新 抓 取 零 件 。 这 个 顺序 持续 进行 ， 直 到 零件 被 最 终 放 
置 在 目标 构 型 上 。 这 个 过 程 的 示意 图 如 图 26. 6 所 示 。 


C grasp2 


图 26. 6 操作 规划 包括 在 混杂 连续 构 型 空间 集合 中 搜索 
一 个 传输 和 过 渡 路 径 序列 ( 这 个 例子 中 ， 由 不 同方 式 
抓 取 零 件 产生 了 不 同 C 空间 中 的 传输 路 径 ) 


26. 3.2 三 自由 度 平面 机 械 手 举例 


对 于 3 个 或 更 少 自由 度 的 机 械 手 ， 我 们 能 建立 可 
视 化 的 C 空间 ， 以 获得 这 种 结构 的 直观 表示 。 在 本 
节 中 ， 我 们 以 一 个 末端 执行 器 工作 在 二 维 平面 工作 空 
fa] (R^) 的 三 自由 度 的 串联 机 械 手 为 例 进 行 介绍 。 

图 26.7 给 出 了 一 个 简单 的 宛 余 度 机 器 人 手 
pel 。 机 器 人 有 3 个 转动 关节 ， 甚 转动 轴 相 平行 ， 
关节 范围 是 [ -mw,， mw]， 具有 3 个 自由 度 。 由 于 机 咒 
人 的 末端 执行 器 仅 触及 平面 上 的 位 置 ， 机 器 人 手臂 在 
平面 上 是 元 余 的 。 由 于 它 仅 有 3 个 自由 度 ， 且 每 个 关 
节 角 有 一 定 的 范围 ，C 可 以 可 视 化 为 一 个 边 长 为 27 
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的 立方 体 。 一 般 来 讲 ， 如 果 无 关节 范围 约束 ， 有 个 
转动 关节 的 机 械 手 的 C 空间 与 n 维 超 环 面 是 同 胚 的 ， 
如 果 有 关节 范围 约束 ， 则 与 n 维 超 立方 体 是 同 胚 的 。 
工作 空 = il Cspace 

0 0 ,0 0i 

侧 视 图 
05 
04 05 03 | / 


图 26.7 平面 三 自由 度 机 械 手 


如 上 所 述 ， 工 作 空 间 中 障碍 物 在 C 空间 的 投影 
定义 为 C 障 碍 (第 5 章 ) ， 表 示 机 器 人 与 障碍 物 发 生 
几何 形状 交互 时 机 器 人 的 所 有 关节 构 型 集合 。 

Ci. 21(5,4 ) ECLA) n0 | 

通常 ，C4. 的 结构 高 度 复 杂 ， 包括 C 中 多 个 互联 的 元 
素 。 图 26. 8 给 出 了 平面 三 自由 度 机 械 手 的 构 型 空间 
可 视 化 的 例子 ， 其 中 两 种 盒 形 的 障碍 物 用 不 同 颜色 表 
示 。 工 作 空间 中 的 c 障碍 用 相同 颜色 的 盒 形 障碍 物 
表示 。 红 ， 绿 ， 和 蓝 坐 标 轴 分 别 对 应 机 械 手 的 3 个 关 
节 角 9 11,，2,，3|。 自 碰撞 是 一 个 特殊 的 C 障碍 区 
域 ， 指 机 器 人 自身 关节 几何 形状 的 干涉 ， 并 不 包括 环 
境 的 几何 形状 。 图 26.7 给 出 了 所 设计 的 机 器 人 不 发 
生 自 碰撞 的 区 域 。 图 26. 9 给 出 了 机 械 手 可 能 发 生 实 
际 碰撞 的 自 碰撞 区 域 , 并 可 视 化 表示 为 相应 的 C 障 
碍 。C 障碍 能 覆盖 大 型 的 构 型 空间 ， 其 至 能 隔断 C, 
中 不 同 的 元 素 。 图 26. 10 解释 了 在 障碍 物 上 附加 一 个 
很 小 的 点 ， 可 能 使 很 大 范围 内 的 构 型 产生 碰撞 且 隔 断 
Cu: 与 这 个 点 相应 的 C 障碍 在 构 型 空间 中 形成 了 与 
6, - 06, 平面 平行 的 一 堵 墙 。 这 堵 墙 表示 出 与 该 点 干涉 
的 机 械 手 的 第 一 个 连 杆 的 关节 角 0, 的 取 值 范围 。 由 
于 元 素 的 隔断 ，C, C, e C，， 意 味 着 将 找 不 到 一 条 
无 碰 路 径 由 C, 起 始 ， 至 C, 结束 。 


工作 空间 Cspace 


| 
| 0 
05 


0 0 05 b 
顶 视图 — 


图 26.8 工作 空间 中 存在 盒 形 障碍 物 的 平面 三 
自由 度 机 械 手 以 及 相关 的 构 型 空间 障碍 


工作 空间 Cspace 


0 0 4,05 
侧 视 图 


0 
顶 视图 


图 26.9 非 平面 三 自由 度 机 械 手 和 相应 的 自 碰撞 C 障碍 


工作 空间 Cspace 


顶 视图 
障碍 


——— 


图 26. 10 工作 空间 投影 到 构 型 空间 时 被 分 割 的 拓扑 形状 


26.3.3 逆向 运动 学 思考 


在 构造 路 径 规 划 问 题 时 ， 需 要 一 个 目标 构 型 4, 
为 输入 ( 见 第 5 章 ) 。 在 操作 规划 时 ， 通 常 根据 末端 
执行 器 在 工作 空间 中 的 理想 位 姿 ， 由 道 向 运动 学 
(IK) 求解 方法 ( 见 1.7 节 ) 计算 出 这 个 构 型 。 对 宛 
余 度 机 构 (超过 6 个 自由 度 ) 而 言 ， 特 殊 情况 除外 ， 
并 不 存在 逆向 运动 学 的 已 知 的 解析 求解 方法 。 这 种 情 
况 下 ,通常 采用 迭代 或 数值 方法 (如 基于 雅 可 比 的 
方法 或 基于 梯度 的 优化 方法 ) 来 进行 求解 。 注 意 ， 
逆向 运动 学 的 数值 计算 结果 与 初始 解 的 质量 、C 空间 


中 奇异 点 的 分 布 或 所 有 这 些 因 素 相 关 ， 计 算 效率 可 能 
很 差 ， HAA (1.74). 

已 知 末 端 执行 器 位 姿 ， 多 数 人 求解 方法 只 能 计 
算出 一 个 构 型 。 然 而 ， 对 于 元 余 度 机 械 手 ， 末 端 执行 
器 的 一 个 已 知 的 期 望 位 姿 ， 对 应 无 限 的 、 连 续 范围 的 


构 型 。 在 路 径 规划 时 ， 这 意味 着 TK 求解 方法 要 从 无 
限 数量 的 构 型 中 选择 出 来 一 个 作为 9。 注意 ,在 某 
些 情况 下 ， 所 选 出 来 的 9 可 能 会 发 生 碰撞 ， 即 不 是 
Cu 的 一 部 分 。 因 为 并 不 存在 与 传统 意义 上 路 径 规划 
结果 相对 应 的 解 ， 这 个 构 型 不 能 用 来 作为 计算 全 局 直 
近 策略 的 目标 ( 见 第 5 章 )。 

另 一 种 可 能 性 是 所 选择 的 ,与 4 隔断 。 这 种 
情况 下 ,尽管 gi 是 Cv 的 一 个 元 素 ， 但 其 所 在 区 域 
与 gu 的 所 在 区 域 是 隔断 的 ， 其 不 宜 用 来 进行 规划 。 
考虑 如 图 26.7 所 示 的 平面 机 械 手 ， 图 26. 11 给 出 了 


PA 
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末端 执行 器 某 个 位 姿 所 对 应 的 两 种 可 能 的 解 。 相 应 的 


Ig = a RET UE ENIM d 
构 型 为 4, = (0, F. 0) 和 4, = (0. - 5. 5) 在 
可 视 化 的 C 空间 中 表示 为 绿色 球体 。 这 种 情况 下 ， 
下 求解 方法 可 能 选择 二 者 之 一 作为 qu 。 如 果 将 图 


而 对 于 末端 执行 器 的 位 次 和 机 械 手 的 构 型 ， 则 允许 有 
一 定 柔 性 和 自由 。 这 是 任务 空间 或 操作 空间 控制 技术 
的 一 种 优势 ( 见 6.2 节 )。 

举 个 例子 ,考虑 用 平面 三 自由 度 机 械 手 抓 取 一 个 
圆柱 形 零件 的 任务 。 图 26. 11 给 出 了 产生 末端 执行 器 


26. 10 中 的 障碍 物 加 在 工作 空间 中 ， 两 个 解 则 位 于 
Ci 的 隔断 的 两 个 区 域内 ， 如 图 26. 12 所 示 。 
工作 空间 C space 
05 


03 02 $ a) = (0,2,0) 
03 A - 01 
03 
04 05 0 


b) = (7,-3.9) 
a) b) c) 


图 26. 11 平面 三 自由 度 手臂 末端 执行 器 
姿态 相同 时 逆向 运动 学 的 两 个 解 


工作 空间 Cspace 


"T 
= a 
障碍 物 
a) b) 


图 26. 12 由 于 工作 空间 中 的 一 个 小 的 障碍 物 ， 使 得 逆向 
运动 学 的 两 个 解 位 于 C we。 中 两 个 隔断 的 区 域 


令 qu, =(0, 0, 0) 为 零 构 型 ， 表 示 为 图 26. 12 
中 的 C 空间 坐标 轴 上 的 交叉 点 。 将 这 个 构 型 所 在 的 
Ci 部 分 称 为 C ， 男 一 部 分 称 为 C,。 由 于 gq, ec H 
Cnc =O, WR IK 求解 方法 选择 gq, 作为 doas M 
规划 问题 将 无 解 存在 。 这 意味 着 以 qi 为 目标 的 规划 
必定 失败 。 
由 于 计算 C 空间 连接 性 的 完整 表示 与 路 径 规划 
的 复杂 程度 相似 ， 在 规划 失败 前 ， 基 本 上 不 可 能 检测 
出 qu 与 gm 的 非 连接 性 。 

如 上 所 述 ， 经 典 操作 规划 问题 在 工作 空间 中 的 目 
标定 义 为 采用 逆向 运动 学 计算 出 的 末端 执行 器 的 期 户 
位 姿 。 然 而 ， 需 要 注意 的 是 ， 操 作 任 务 的 目的 可 以 不 
要 求 将 未 端 执行 器 移动 到 指定 位 置 ， 而 是 移动 到 任意 
可 行 位 置 ， 只 要 能 完成 期 望 的 操作 任务 即 可 。 因 此 ， 
更 重要 的 是 设计 出 针对 任务 的 计算 方法 和 控制 方案 ， 


相同 位 姿 的 两 个 可 能 的 构 型 解 。 工 作 空间 中 附加 的 障 
碍 物 可 能 使 其 中 的 一 个 解 与 初始 构 型 隔断 。 然 而 ， 这 
两 个 构 型 可 能 不 是 机 械 手 抓 取 圆柱 形 零件 的 唯一 有 效 
解 。 图 26. 13a 给 出 了 机 械 手 能 抓 取 零 件 的 其 他 几 种 
构 型 。 通 过 在 这 些 构 型 中 插值 ， 可 以 得 到 无 限 数量 的 
不 同 的 工作 空间 位 姿 ， 作 为 抓 取 问 题 的 解 。 与 这 些 工 
作 空间 位 姿 相 关 的 逆向 运动 学 的 解 位 于 一 个 连续 的 子 
集中 C,, EC, WE 26. 13b 所 示 ， 代 表 了 实现 这 个 任 
务 的 规划 问题 的 实际 解 空 间 。 
把 图 26. 10 中 的 障碍 物 加 在 操作 任务 的 工作 空间 
中 ， 所 产生 的 构 型 空间 如 图 26. 14 所 示 。 注 意 ， 为 清 
楚 起 见 ， 机 械 手 与 圆柱 的 自 碰撞 所 对 应 的 C 障碍 没 
有 出 现在 可 视 化 的 结果 中 。 大 约 一 半 的 可 行 解 是 与 初 
始 构 型 分 隔 开 的 ， 四 分 之 一 解 在 碰撞 区 域 ， 只 有 四 分 
之 一 解 是 可 达 的 ， 因 此 ， 其 可 以 作为 经 典 规划 求解 
du 的 合适 的 候选 解 。 


ape 
EPS 


Æ 26.13 a) 工作 空间 例子 求解 : 机 械 手 能 抓 取 圆柱 的 
多 个 构 型 b ) C 空间 求解 区 域 : 构 型 解 集 的 可 视 化 C 空间 


02 
05 
05 
0 
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Ed 26.14 抓 取 圆柱 零件 时 在 隔断 的 C 空间 中 
目标 构 型 集 ( 绿色 ) 的 两 个 视图 
本 节 中 ， 我 们 介绍 了 操作 规划 的 基础 ， 提 出 了 适 
于 各 种 搜索 空间 的 数学 方法 ， 讨 论 了 关于 几何 形状 


b) 


| 
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和 拓扑 的 重要 问题 。26.6 节 综 述 了 其 他 一 些 主题 ， 
给 出 了 一 些 进一步 阅读 的 资料 。 
26.4 装配 运动 

将 加 工 后 的 零件 组 装 到 一 起 形成 一 个 产品 如 一 部 
机 器 的 过 程 ， 定 义 为 装配 或 装配 任务 。 这 是 任何 产品 
生产 过 程 的 主要 操作 。 机 需 人 实现 装配 自动 化 可 减少 
成 本 ， 提 高 质量 和 操作 效率 。 在 一 些 危险 环境 ， 如 大 
室 ， 让 机 器 人 执行 装配 任务 能 挽救 人 的 生命 。 对 于 机 
器 人 学 来 说 ， 装 配 一 直 是 一 个 既 重 要 又 最 具 应 用 挑战 
性 的 问题 。 在 装配 自动 化 的 广阔 领域 中 ， 有 很 多 相关 
的 重要 研究 问题 ， 从 装配 设计 到 误差 分 析 ， 装 配 次 序 
规划 ,夹具 设 计 等 。 本 节 主 要 讨论 面向 装配 的 机 器 人 
运动 问题 。 

我 们 所 关心 的 装配 运动 指 机 械 手 抓 持 零件 并 将 
其 移动 到 指定 的 装配 状态 ， 即 达到 目标 空间 位 置 或 
与 其 他 零件 接触 。 装 配 运动 的 主要 难点 在 于 零件 装 
配 状态 所 要 求 的 高 精度 和 低 误 差 。 因 此 ， 装 配 运动 
的 实现 必须 克服 一 些 不 确定 性 。 和 柔顺 运动 定义 为 所 
持 零 件 和 环境 中 的 其 他 零件 相 接触 而 产生 的 约束 运 
动 。 由 于 减少 了 所 持 零 件 的 自由 度数 ， 降 低 了 运 
动 的 不 确定 性 ， 因 此 ， 在 装配 中 期 望 实现 柔顺 
运动 。 

考虑 上 述 介绍 的 轴 孔 装配 例子 ( 见 图 26.2)， 
如 果 轴 和 孔 之 间 的 间距 很 小 ， 不 确定 性 的 影响 容易 
使 轴 的 向 下 插 和 人 运动 失败 ， 即 轴 与 孔 的 边缘 发 生 大 
撞 而 运动 终止 ， 没 有 达到 期 望 的 装配 状态 。 因 此 ， 
成 功 的 装配 运动 必须 通过 移动 轴 来 避免 这 些 不 期 户 
的 状态 ， 使 其 最 终 达 到 期 望 状态 。 为 实现 这 种 过 渡 ， 
通常 都 会 选择 柔顺 运动 。 在 到 达 期 望 的 装配 状态 前 ， 
有 必要 通过 柔顺 运动 产生 一 系列 的 接触 过 渡 。 图 
26.15 给 出 了 轴 孔 装配 任务 的 一 个 典型 接触 过 渡 
次 序 。 

柔顺 运动 的 装配 运动 策略 有 两 个 较 宽 泛 的 分 类 ; 
被 动 柔 顺和 主动 柔顺 运动 ， 两 种 分 类 的 策略 都 要 求 提 
供 描述 零件 之 间 拓扑 接触 状态 的 信息 。 


26.4.1 拓扑 接触 状态 


MERE A 接触 零件 B 时 ，A 或 B 的 构 型 是 接触 构 
型 。 通 常 ， 接 触 构 型 集 享有 共同 的 上 层 接触 特征 。 如 杯 
子 在 桌子 上 ， 是 杯子 底部 在 桌子 上 的 杯子 全 部 接触 构 型 
所 共享 的 上 层 描述 。 由 于 这 个 描述 体现 了 空间 位 置 ， 可 
能 是 装配 状态 ， 也 可 能 仅 是 一 种 零件 之 间 的 接触 状态 
(contact states) ， 其 常用 来 表示 装配 运动 的 关系 。 


图 26.15 轴 孔 装配 任务 中 的 接触 状态 序列 


在 多 面体 物体 接触 时 ， 通 常 将 接触 状态 用 拓扑 
形式 描述 为 基础 接触 ( primitive contact) 集 ， 每 个 
基础 接触 由 一 组 接触 面 元素 包 括 面 、 边 和 顶点 来 定 
义 。 不同 接触 状态 的 本 质 区 别 仅 在 于 基础 接触 的 定 
X b. 参考 文 献 [26.23] 给 出 了 一 种 常用 的 基础 
接触 表示 ， 将 二 维 平面 多 边 形 的 边 和 顶点 接触 ， 三 
维 多 面 体 的 顶点 和 面 接触 、 边 和 边 接触 定义 为 点 接 
触 。 参 考 文献 [26.24] 给 出 了 另外 一 种 表示 ， 将 
基础 接触 定义 为 一 对 拓扑 面 元 素 的 关系 〈 即 面 、 边 
和 顶点 )。 这 里 , 与 点 接触 概念 不 同 ， 基础 接触 能 
描述 出 接触 区 域 是 一 个 点 ， 一 条 线段 ， 或 一 个 平面 。 
然而 ， 在 通过 传 感 识 别 接触 时 ， 尽 管 两 种 表示 对 应 
了 所 定义 的 不 同 接触 状态 ， 但 由 于 不 确定 性 的 影响 ， 
可 能 识别 出 相同 的 接触 结果 。 图 26. 16 给 出 了 这 个 
例子 。 

参考 文献 [26.25, 26] 将 主 接触 (principal 
contact) 作为 上 层 基础 接触 ， 表 现 出 对 识别 问题 的 更 
强 鲁 棒 性 。 一 个 主 接触 (PC) 定义 为 一 对 拓扑 面 元 
素 的 接触 ， 且 不 是 其 他 拓扑 接触 面 的 边界 元 素 。 一 个 
面 的 边界 元 素 是 位 于 边界 的 边 和 顶点 ,一 条 边 的 边界 
元 素 是 位 于 边界 的 顶点。 两 个 物体 间 的 不 同 的 PC 对 
应 物体 的 不 同 的 自由 度 ， 也 通常 对 应 着 接触 力 和 力矩 
的 显著 区 别 。 如 图 26. 16 所 示 ， 基 础 接触 所 不 能 区 分 
1 的 状态 ， 定 义 为 PC 的 一 个 状态 。 因 此 ，PC 中 的 接 
触 状态 数目 更 少 ， 是 接触 状态 的 一 种 更 简洁 的 描述 。 
事实 上 ， 两 个 是 多边形 物体 之 间 的 每 种 接触 状态 都 可 
以 由 一 个 PC 表示 。 
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图 26. 16 上 面 零件 的 不 同位 置 对 接触 状态 的 影响 很 小 
a) 两 个 物体 b) 状态 1 c) 状态 2 


26.4.2 ”被 动 柔 顺 


被 动 柔 顺 指 在 装配 运动 中 ， 进 行 误差 修正 的 柔顺 
运动 的 策略 ， 并 不 要 求 对 零件 间接 触 状 态 的 主动 而 精 
确 的 识别 和 推理 。 

1. 远程 中 心 柔顺 

在 20 世纪 70 年 代 ， 开 发 了 一 个 远程 中 心 柔 顺 
(RCC) 设备 ,实现 高 精度 的 轴 孔 装配 ”1。RCC 
是 一 个 机 械 弹 簧 结构 ， 连 接 在 机 械 手 末端 执行 器 上 ， 
作为 握 住 圆柱 形 轴 插入 圆 孔 的 工具 。 在 插入 方向 上 ， 
RCC 的 设计 刚度 很 高 ， 但 也 具有 很 高 的 横向 柔性 天 
和 转动 柔性 K,。 令 柔性 中 心 接近 轴 的 端 部 (远程 中 
心 柔 顺 以 此 命名 ) ， 以 克服 在 插入 过 程 中 由 孔 施加 给 
轴 的 接触 力 而 引起 的 轴 位 置 和 方向 的 横向 和 转动 角度 
的 小 误差 〈 见 图 26.17), RCC 较 大 的 横向 和 转动 柔 
顺 性 也 有 利 地 避免 了 模 紧 和 卡 阻 。 横 紧 是 由 对 立方 向 
的 接触 力 使 轴 陷 于 两 点 接触 状态 ， 而 卡 阻 则 是 由 力 或 
力矩 的 比例 不 适当 而 引起 的 。 由 于 RCC 是 实现 快速 
插入 的 低 成 本 可 靠 设 备 ， 在 工业 领域 得 到 了 长 期 的 成 
功 应 用 。 

Ski, RCC 也 有 和 缺点 。 它 仅 适 用 于 圆 形 的 轴 孔 
装配 ， 对 于 轴 和 和 孔 的 特殊 尺寸 ， 最 好 设计 专门 的 
RCC。 为 扩展 RCC 的 适用 性 进行 了 很 多 工作 。 一 些 
工作 使 RCC 的 某 些 参数 可 调 ， 以 实现 可 变 的 柔顺 性 
或 可 调 的 远程 中 心 位 置 ? 221。 参考 文献 【26. 33 ] 
提出 了 一 种 空间 RCC (SRCC) ， 以 实现 方形 轴 孔 的 
装配 。 由 此 扩展 产生 了 一 种 显著 差别 ， 就 是 所 持 零 件 
的 位 置 和 方向 的 不 确定 性 在 一 定 范围 内 时 、 可 能 产生 
接触 状态 数 的 组 合 爆炸 ， 这 必须 在 设备 的 设计 时 就 考 
虑 到 。 与 圆 形 轴 孔 装配 不 同 ， 其 是 基本 的 二 维 问题 ， 


图 26. 17 a) RCC 的 平面 表示 b) 使 工件 转动 的 RCC 
的 转动 部 分 cO 使 工件 平 动 的 RCC 的 平 动 部 分 


公有 几 种 不 同 的 接触 状态 ， 在 方形 轴 孔 之 间 有 上 百 种 
不 同 的 接触 状态 。 从 其 中 的 一 种 可 能 接触 状态 到 达 目 
标 装 配 状态 ， 必 须 通过 设备 来 实现 所 持 零 件 的 运动 。 
很 难 设计 出 一 种 RCC 设备 ， 能 适应 有 更 多 种 可 能 接 
触 状态 的 更 普通 、 更 复杂 形状 的 零件 。 这 是 一 个 主要 
制约 因素 ， 它 阻碍 了 RCC 实现 不 同 零件 装配 的 进 一 
步 扩 展 。 

2. SR BE 

作为 RCC 的 一 种 蔡 代 方 法 ， 提 出 了 一 种 机 械 
手 力 控 制 的 特殊 形式 一 -阻尼 控制 ,来 实现 机 械 
手 所持 零 件 的 柔顺 运动 ， 以 改正 所 持 零 件 在 装配 
过 程 中 小 的 定位 误差 。 这 种 方法 减少 了 为 改正 错 
误 而 建立 一 个 类 似 RCC 的 机 械 设备 的 需求 。 在 力 
控制 方法 中 '*“”， 阻 尼 控 制 是 一 种 常见 的 策略 ， 
其 根据 感知 的 所 持 零 件 与 环境 之 间 的 接触 力 ， 修 
改 所 持 零件 的 速度 命令 。 所 产生 的 实际 速度 逐渐 
减少 ， 并 有 望 最 终 修正 所 持 零 件 的 位 置 和 方向 的 
小 误差 。 令 "为 一 个 六 维 向 量 ， 代 表 所 持 零件 的 实 
际 平 动 和 转动 速度 ，wm 为 六 维 速度 命令 ，yj 为 一 个 
六 维 向 量 ,， 代 表 检 测 到 的 力 和 力矩 。 则 线性 阻尼 
de il e n] EA YR DN : 

v=v,tAf 

式 中 ,A 是 一 个 6 x6 的 矩阵 ， 称 为 导 纳 矩 阵 或 容纳 
FEE 

这 种 阻尼 控制 的 效果 取决 于 是 否 存 在 一 个 合适 的 
TAERA, URURI E, HFA 的 设计 有 很 多 
人 研究， 使 得 在 轴 孔 装配 过 程 中 遇 到 的 任何 接触 状态 ， 
都 能 成 功 地 完成 装配 操作 并。 其 针对 这 样 一 种 
情形 ， 即 在 没有 不 确定 性 或 错误 时 ， 一 个 单独 的 速度 
命令 就 足以 实现 装配 操作 ， 如 确定 的 轴 在 孔 中 的 插入 
操作 。 在 所 有 可 能 的 接触 状态 和 匹配 要 求 下 ， 对 接触 
条 件 的 运动 和 静 力 的 明确 分 析 ， 是 设计 4 的 一 种 主 


g 
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要 方法 ， 其 生成 一 系列 的 线性 不 等 式 作 为 4 的 约束 
条 件 。 也 可 以 通过 使 力 最 小 化 的 学 习 方法 得 到 4， 
可 避免 产生 不 稳定 性 “” 。 另 一 种 方法 “” 是 在 插 
入 过 程 中 ， 通 过 在 末端 执行 器 上 加 干扰 来 获得 更 丰 寅 
的 力 信息 。 

3. 装配 的 学 习 控制 

另 一 类 的 方法 是 针对 某 种 装配 操作 ， 通 过 随机 或 
神经 网 络 方法 学 习 得 到 合适 的 控制 “*% 和 1。 大 多 数 
方法 的 本 质 是 通过 学 习 ， 建 立 所 持 物体 接触 反应 力 和 
下 一 步 速度 命令 之 间 的 映射 关系 ， 以 减少 误差 、 实 现 
成 功 的 装配 操作 。 最 近 的 一 种 方法 失当 建立 了 人 执 
行 装配 任务 示范 所 获得 的 位 瓷 和 视觉 的 传 感 信息 融 
合 ， 与 成 功 装配 所 需要 的 柔顺 运动 信号 之 间 的 映射 
关系 。 

男 一 种 方法 是 通过 视觉 “或 在 虚拟 环境 
中 性 “观察 人 工 操作 执行 装配 任务 ， 生 成 一 种 成 
功 完成 任务 所 必需 的 运动 策略 ， 包 括 一 系列 可 识别 的 
接触 状态 转移 和 相关 运动 参数 。 
由 于 可 以 生成 一 个 速度 命令 序列 ， 其 与 RCC 或 


零件 到 达 指 定 的 目标 状态 。 


en 


a) b) 


Vo 


Æ 26.18 位 置 和 速度 的 不 确定 性 CC 空间 中 ) 
a) 零件 的 实际 构 型 可 能 在 以 所 观测 到 的 构 型 为 
中 心 的 不 确定 球 中 b) 零件 的 实际 速度 可 能 在 
于 绕 给 定 速度 的 一 个 不 确定 的 锥 体 中 


已 知 所 持 物体 的 初始 位 置 和 目标 状态 ， 原 像 方法 
是 沿 反 向 链 生成 运动 规划 ， 通 过 寻找 与 速度 命令 相关 
的 目标 状态 的 原 像 ， 然 后 是 原 像 的 原 像 ， 等 等 ， 直 到 
发 现 包括 所 持 零 件 初始 构 型 的 原 像 。 图 26. 19 给 出 了 
一 个 例子 。 与 原 像 序列 相关 的 速度 命令 序列 (从 包 
括 初始 位 置 的 初始 原 像 开始 ) 形成 了 运动 规划 ， 保 
证 任务 成 功 。 从 初始 原 像 开始 ， 在 序列 中 每 个 后 续 的 
原 像 都 可 以 看 做 一 个 子 目标 状态 。 在 这 种 方法 中 ， 只 


基于 上 述 单个 导 纳 和 矩阵 的 策略 不 同 ， 能 应 用 在 不 确定 
性 很 大 的 情况 下 。 然 而 ， 通 过 学 习 得 到 的 控制 器 是 与 
任务 相关 的 。 

所 有 上 述 装 配 运 动 策 略 不 要 求 明确 识别 出 执行 过 
程 中 的 接触 状态 。 


26.4.3 ”主动 柔顺 运动 


主动 柔顺 运动 的 特点 是 基于 对 接触 状态 的 在 线 辩 
识 或 识别 ， 以 及 接触 力 的 反馈 来 实现 纠 错 。 主 动 柔顺 
运动 能 力 使 机 器 人 能 灵活 地 处 理 范 于 更 广 、 不 确定 性 
更 大 的 装配 任务 ， 以 及 装配 之 外 的 需要 和 柔顺 的 任务 。 
主动 柔顺 系统 通常 需要 下 列 组 成 部 分 : 一 个 规划 器 进 
行 柔 顺 运动 命令 的 规划 ; 一 个 辨识 器 来 识别 接触 状 
态 ， 状 态 转 移 ， 和 任务 操作 过 程 中 的 其 他 状态 信息 ; 
一 个 控制 器 ， 同 时 基于 由 传感器 提供 的 底层 反馈 和 由 
辨识 器 提供 的 上 层 反 馈 ， 来 执行 柔顺 运动 。 每 个 部 分 
的 研究 内 容 介绍 如 下 。 

1. 精细 运动 规划 

精细 运动 规划 是 指 规划 精细 规模 的 运动 ， 在 不 确 
定性 很 大 的 情况 下 也 能 成 功 实 现 装配 任务 。 参 考 文 
献 光 1 提出 了 一 种 基于 构 型 空间 (C 空间 ) e 
(preimages) 概念 的 通用 方法 ,设计 出 一 种 存在 不 确 
定性 时 也 不 会 失败 的 运动 策略 ”1。 已 知 目标 构 型 
的 一 个 区 域 定 义 了 所 持 零件 的 目标 状态 ， 目 标 状 态 的 
原 像 对 那些 构 型 进行 编码 ， 使 得 尽管 存在 位 置 和 速度 
的 不 确定 性 〈 见 图 26.18) ， 速 度 命令 仍 能 确保 所 持 


要 有 可 能 就 要 选择 柔顺 运动 ， 因 为 柔顺 运动 通常 比 纯 
定位 运动 生成 更 大 的 原 像 *” ， 且 子 目 标 状态 通常 
是 接触 状态 。 参 考 文献 [26.49] 进一步 扩展 了 该 办 
法 ， 包 括 物体 的 建 模 不 确定 性 。 


b) 


Fd 26.19 原 像 的 反 向 链 : 
P E ERG 的 原 像 ，P ,是 P | 的 原 像 


然而 ， 该 方法 的 计算 性 是 一 个 大 问题 。 在 存在 传 
感 不 确定 的 情况 下 ， 目 标 可 达 性 和 可 识别 性 的 双重 要 
求 相互 交织 在 一 起 ,使 原 像 的 计算 变 得 复杂 。 参 考 文 
献 [26. 50] 给 出 了 生成 规划 的 时 间 复 杂 度 是 nmr 的 
ABBA, HP n 是 规划 的 步 数 ，m 是 环境 复杂 
BE (物理 空间 的 ), r 是 构 型 空间 的 维 数 。 通 过 分 离 
可 达 性 和 可 识别 性 ， 并 限制 最 初 原 像 模型 的 可 识别 能 
力 ， 使 计算 性 得 到 了 改善 * 3 。 

一 种 两 步 法 取而代之 ,能 简化 精细 运动 规划 : 
QD 假设 没有 不 确定 性 的 全 局 和 离线 名 义 路 径 规划 ; 
书局 部 和 在 线 重新 规划 ， 以 处 理由 于 不 确定 性 而 产生 
的 意外 接触 。 已 提出 了 两 步 法 的 不 同 变化 形 
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ISS 。 该 方法 的 成 功 与 和 否 取 决 于 对 接触 状态 的 
在 线 识 别 效果 (SL 26.4.3 节 )。 一些 研究 人 员 还 研 
究 了 不 确定 性 的 表示 和 传播 ， 以 及 任务 成 功 需 要 满足 
Begg e OO 

2. 柔顺 运动 规划 

柔顺 运动 规划 的 重点 是 规划 物体 运动 保持 接触 。 
Hopcroft 和 Wilfong'*“1 证 明 ， 如 果 任 意 两 个 接触 物体 
可 以 移动 到 另 一 个 构 型 上 且 仍 然 保持 接触 ， 则 始终 存 
在 一 条 接触 构 型 路 径 (在 障碍 物 构 型 空间 或 C 障碍 
物 的 边界 ) 连接 第 一 和 第 二 个 接触 构 型 。 因此， 和 柔 
顺 运动 不 仅 在 许多 情况 下 是 理想 的 ， 而 且 在 已 知 初始 
和 目标 接触 构 型 的 情况 下 总 是 可 行 的 。 
由 于 柔顺 运动 发 生 在 C 障碍 的 边界 上 ， 柔 顺 运 
动 规划 提出 了 无 碰 运 动 规划 不 曾 面 对 的 挑战 : 它 要 求 
C 障碍 边界 上 接触 构 型 的 准确 信息 。 和 遗憾 的 是 计算 C 
障碍 至 今 仍 是 一 项 艰巨 的 任务 。 尽 管 采用 三 维 参数 方 
法 将 C 障碍 准确 描述 为 多 边 形 !*%"1 ， 然 而 它 只 是 
六 维 C 障碍 多 面体 的 一 个 近似 汪汪 RH m A n 
表示 两 个 多 面体 接触 的 复杂 度 ， 则 C 障碍 的 复杂 度 
X Gat em 

研究 人 员 的 重点 放 在 减少 问题 的 维 数 和 范围 ， 或 
者 完全 避免 计算 C 障碍 的 问题 。 一 些 研究 人 员 研 究 
了 降 维 的 C 障碍 的 柔顺 运动 规划 天 ?7 。 更 常用 的 
是 基于 拓扑 接触 状态 预 设 图 的 方法 ， 以 避免 计算 C 
paren O79) 。 一 种 特别 的 方法 ”是 采用 Petri 网 
将 多 边 形 零件 的 装配 任务 建 模 为 离散 事件 系统 。 然 
而 ， 接 触 状态 和 状态 转移 通常 是 人 工 生成 ， 对 于 几何 
形状 很 简单 的 装配 任务 ， 这 种 工作 也 是 相当 乏味 
的 到 3 ， 而 对 于 复杂 任务 ， 由 于 不 同 的 接触 状态 的 
数量 巨大 ， 则 无 法 实现 。 

因此 ， 能 自动 生成 一 个 接触 状态 图 ， 既 是 理想 的 
又 是 必要 的 。 参 考 文献 [26.77] 提出 的 一 种 方法 是 
首先 列举 出 所 有 可 能 的 接触 状态 ， 以 及 两 个 凸 多 面体 
之 间 的 联系 。 回 想 一 下 ， 两 个 凸 多 面体 的 接触 状态 可 
以 描述 为 一 个 主 接触 (26.4.1 节 ) ， 且 两 个 凸 多 面体 
的 两 个 拓扑 面 元 素 的 任何 主 接触 都 描述 了 一 个 几何 有 


= 


效 的 接触 状态 。 这 些 都 是 很 好 的 性 质 ， 并 大 大 简化 了 
接触 状态 图 产生 的 问题 。 然 而 ， 一 般 来 说 ， 为 了 自动 


构建 两 个 物体 之 间 的 接触 状态 图 ， 需 要 处 理 两 个 相当 
难 的 问题 : 

1) 如 何 生 成 有 效 的 接触 状态 ， 即 已 知 物体 的 几 
何 尺 寸 ， 如 何 判 断 一 个 主 状态 集 对 应 一 个 几何 有 效 的 
接触 状态 ; 

2) 如 何 将 图 中 的 一 个 有 效 的 接触 状态 和 男 一 个 
联系 起 来 ， 即 在 接触 构 型 空间 中 ， 如 何 找到 属于 不 同 


接触 状态 的 接触 构 型 区 域 中 的 近邻 (或 相 邻 ， 关 系 。 

参考 文献 [26. 26] 介绍 了 一 种 通用 而 有 效 的 分 
而 合并 的 方法 ， 用 于 自动 生成 任意 两 个 多 面体 之 间 的 
接触 状态 图 。 图 中 的 每 个 节点 代表 一 个 接触 状态 ， 通 
过 拓扑 接触 形式 (CF) 7°79! 描述 为 一 个 主 接触 集 和 
满足 CF 的 一 个 构 型 。 每 条 边 连接 两 个 相 邻 接触 状态 
的 节点 。 图 26.20 给 出 了 两 个 平面 零件 间 的 接触 状态 
图 的 例子 。 


图 26. 20 ”两 个 平面 零件 接触 状态 图 


该 方法 通过 直接 利用 拓扑 和 物理 空间 中 物体 接触 
的 几何 知识 ， 以 及 问题 可 分 解 为 更 简单 的 生成 与 合并 
特殊 子 图 的 子 问 题 ， 同 时 人 处理 上 述 两 种 情况 。 具 体 来 
说 ， 该 方法 利用 了 接触 状态 图 可 分 为 特殊 子 图 的 性 
质 ， 特 殊 子 图 称 为 目标 接触 松弛 (GCR) 图 ， 其 中 
每 个 GCR 定义 为 一 个 局 部 最 强 约束 的 有 效 接触 状态 ， 
即 所 谓 的 种 子 ， 以 及 其 邻 域 弱 约束 的 有 效 接触 状态 。 
鉴于 一 些 性 质 这 些 接触 状态 更 容易 生成 。 这 些 主要 性 
质 包 括 : 

1) 已 知 有 效 的 接触 状态 C5,;,， 其 所 有 弱 约 束 的 
邻 域 接触 状态 均 可 由 CS, 中 的 主 接触 进行 拓扑 假设 ; 

2) 当 且 仅 当 存在 一 种 柔顺 运动 使 Cs, 的 固定 约 

条 件 放宽 以 得 到 CS ， 而 不 会 产生 任何 其 他 接触 状 

态 ， 则 假设 的 弱 约 束 领 域 接触 状态 CS, 是 有 效 的 ， 称 
为 邻 域 松弛 ; 

3) 通常 采用 瞬 态 柔顺 运动 可 得 到 邻 域 松弛 。 

通过 这 种 方法 ， 能 在 几 秒 钟 内 生成 接触 状态 
数 百 或 上 千 的 节点 和 连接 。 

采用 这 种 接触 状态 图 ， 柔 顺 运动 规划 问题 可 分 解 
为 两 个 层次 上 的 两 个 更 简单 的 子 问题 : CD EJ. 在 接 
和 触 状 态 图 中 从 一 个 节点 到 另 一 个 节点 的 状态 转移 的 图 
搜索 ; OKE: 在 受 同 样 接触 状态 (和 同样 接触 信 
E) 约束 的 接触 构 型 集中 的 接触 运动 规划 ， 称 为 CF 
柔顺 运动 规划 。 可 以 认为 一 个 跨越 了 几 个 接触 状态 的 
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常用 接触 运动 规划 ， 是 由 一 段 段 不 同 接触 状态 的 CF 
柔顺 运动 构成 。 参 考 文献 [26.78] 提出 了 一 种 方 
法 ， 基 于 CF 柔顺 构 型 的 随机 采样 来 规划 CF 的 柔顺 
运动 ， 参 考 文献 [26. 79] 扩展 了 概率 图 的 运动 规划 
FE. 

3. 接触 状态 识别 

精细 运动 或 柔顺 运动 规划 的 成 功 执行 取决 于 在 执 
行 过 程 中 对 接触 状态 的 正确 识别 。 接 触 状态 的 识别 同 
时 利用 接触 状态 的 模型 信息 (包括 拓扑 、 几 何 和 物 
理 信息 )， 以 及 对 末端 执行 器 的 位 置 和 力 /力矩 的 传 
感 信息 。 由 于 存在 传 感 不 确定 性 ， 识 别 问题 是 一 个 重 
要 的 问题 。 根 据 处 理 不 确定 性 的 差异 可 将 接触 状态 和 
识别 方法 分 为 以 下 几 种 。 

类 方法 通过 学 习 得 到 传 感 数据 和 相应 接触 状态 

之 间 的 映射 关系 (存在 传 感 不 确定 性 ) 。 学 习 模型 包 
括 隐 马尔 可 夫 模 型 OBEY fay E E 8788) ， 神 经 网 络 
BER AB PROS 。 可 由 非 监 督 方式 或 以 人 执 
行 任务 的 示范 获得 训练 数据 。 这 种 办 法 是 任务 相关 
的 : 新 的 任务 或 环境 需要 新 的 训练 。 

另 一 类 方法 是 基于 接触 状态 的 解析 模型 。 一 种 常 
见 的 策略 是 先 确定 构 型 集 和 构 型 的 约束 ， 或 力 / 力 矩 
集 ， 或 每 个 可 能 接触 状态 的 力 / 力 矩 的 约束 ， 并 将 这 
些 信 息 与 传 感 数据 进行 在 线 匹配 ， 以 识别 接触 状态 。 
一 些 方法 不 考虑 不 确定 性 的 影响 *””， 而 其 他 方 
法 则 对 不 确定 性 进行 建 模 ， 采 用 不 确定 性 边界 或 概率 
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间 中 接触 元 素 的 距离 检测 ， 在 位 姿 不 确定 性 下 增长 物 
体 的 尺寸 与 所 得 到 的 区 域 相交 '*”， 或 将 物体 间 的 
距离 与 其 他 几 种 因素 结合 起 来 , 如 瞬时 趋 近 
方向 。 

根据 传 感 数据 的 使 用 方式 ， 我 们 认为 一 些 识 别 原 
理 是 静态 的 ， 这 是 由 于 在 到 达 当 前 接触 状态 前 ， 并 不 
考虑 之 前 的 运动 和 状态 识别 ， 而 其 他 方法 采用 历史 信 
息 甚 至 新 的 运动 和 主动 传 感 ， 以 帮助 识别 当前 状态 。 
后 者 包括 了 同时 进行 接触 状态 识别 和 参数 估计 的 方 
法 。 该 方法 中 ， 接 触 状态 模型 解析 表示 为 一 个 不 确定 
参数 的 函数 ， 如 物体 接触 中 的 位 姿 或 尺寸 。 在 每 一 个 
接触 状态 上 ， 一 些 不 确定 的 参数 是 可 观 的 ， 或 在 减少 
不 确定 性 时 是 可 估计 的 。 例 如 ， 如 果 所 持 物体 与 另 一 
个 物体 是 面 面 接触 ， 则 表示 接触 面 法 线 方 向 的 参数 可 
由 力 / 力 矩 传 感 数据 进 行 估 计 。 在 任务 执行 过 程 中 
( 即 运 动 规划 的 执行 )， 接 触 状态 识别 有 助 于 提高 不 
确定 参数 估计 的 准确 性 ， 进 而 也 使 随后 的 接触 状态 识 
别 更 准确 。 这 也 提高 了 力 控 制 和 接触 状态 转移 监测 的 
效果 。 然 而 ， 所 提高 的 性 能 带 来 更 高 的 计算 成 本 。 
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同时 进行 接触 状态 识别 和 参数 估计 时 ， 最 常 做 的 
是 排除 与 传 感 数据 或 参数 估计 结果 不 一 致 的 接触 状态 
Beery OO 。 参 考 文献 【26. 105] 给 出 了 一 个 明显 
的 例外 ， 通 过 将 系统 描述 为 一 个 接触 状态 和 参数 的 混 
合 联合 概率 分 布 ， 实 现 真 正 的 同时 估计 。 

主动 传 感 对 施加 力 / 力 抑或 运动 进行 仔细 设计 ， 
以 更 好 地 辅助 接触 状态 识别 和 参数 估计 。 前 面 研究 的 
重点 是 单一 力 的 策略 * "或 可 移动 性 测试 ”1。 
最 近 ， 参 考 文献 [26.107] 介绍 了 一 些 方 法 ,设计 
优化 的 接触 状态 转移 次 序 和 柔顺 运动 策略 ， 通 过 主动 
传 感 确定 出 在 到 达 一 定 目标 接触 状态 时 所 有 不 确定 的 
几何 参数 。 

参考 文献 [26. 108] 介绍 了 一 种 方法 ， 在 接触 
状态 识别 器 或 参数 估计 器 的 设计 阶段 ， 从 不 同 的 角度 
分 析 接 触 状态 的 可 区 分 性 和 未 知 /不 确定 参数 的 可 识 
别 性 。 

4. 柔顺 运动 规划 的 执行 

尽管 柔顺 或 力 控 制 是 一 个 普遍 研究 的 课题 ( 见 
第 8 章 )， 但 迄今 为 止 ， 如 何 自动 执行 一 个 柔顺 运动 
规划 的 研究 还 很 少 。 

一 般 的 柔顺 运动 规划 (作为 柔顺 运动 或 精细 运 
动 规划 器 的 输出 ) 通常 包括 一 系列 的 接触 状态 ， 和 
在 每 个 接触 状态 内 相对 于 接触 状态 柔顺 并 能 到 达 此 系 
列 中 下 一 个 接触 状态 的 接触 构 型 路 径 。 仅 有 这 种 拓扑 
和 几何 信息 是 不 足以 实现 柔顺 控制 器 的 规划 执行 ， 特 
别 是 在 有 许多 不 同 的 和 复杂 的 接触 状态 时 。 

混合 位 置 / 力 控制 器 要 求 具有 能 将 力 控制 的 维 数 
和 位 置 / 速 度 控制 的 维 数 区 分 开 的 规范 条 件 。 这 种 规 
范 不 仅 随 不 同 接触 状态 而 变化 ， 而 且 在 同一 个 接触 状 
态 内 由 一 个 接触 构 型 到 另 一 个 接触 构 型 时 也 产生 变 
化 ， 即 控制 规范 通常 是 沿 柔顺 轨迹 的 时 间或 构 型 的 函 
数 。 此 外 ， 为 包含 多 个 主 接触 的 复杂 接触 状态 制定 控 
制 规范 ， 远 非 一 件 易 事 '* 9), 

最 近 介 绍 了 一 种 方法 “1 ， 将 一 系列 接触 状态 
下 的 接触 构 型 的 柔顺 路 径 自 动 转换 为 混合 控制 器 的 扳 
动 、 扭 转 和 位 置 控 制 信号 Wt), ta), Mp) 来 执 
行规 划 。 该 方法 成 功 地 进行 了 实验 验证 。 

然而 ， 目 前 尚 没 有 关于 规划 、 在 线 接 触 状 态 识 
别 、 在 线 重新 规划 (处理 那些 由 于 不 确定 性 原因 而 
产生 的 偏离 预 规划 路 径 的 接触 状态 ) ， 柔 顺 运动 控 币 
的 完全 集成 方法 。 


集成 反馈 控制 和 规划 
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26. 5 


在 前 面 几 节 我 们 讨论 了 任务 级 控制 方法 和 规划 算 
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法 。 任 务 级 控制 和 规划 方法 都 能 处 理 在 执行 操作 任务 
时 作用 在 机 器 人 运动 上 的 具体 约束 。 然 而 ,正如 图 
26.3 所 示 ， 这 些 方 法 都 不 能 处 理 所 有 的 约束 。 控 制 
仍然 容易 受到 局 部 极 小 的 影响 ， 因 此 不 能 保证 一 个 运 
动能 到 达 预 期 的 结果 。 男 一 方面 ， 规 划 方 法 通过 将 可 
能 的 运动 放 到 未 来 以 预测 运动 序列 能 否 成 功 ， 克 服 了 
局 部 极 小 的 问题 。 在 一 定 的 假设 条 件 下 ， 所 产生 的 规 
划 能 保证 成 功 。 然 而 ， 与 这 个 过 程 相关 的 计算 太 复 
杂 ， 难 以 满足 操作 任务 反馈 的 要 求 。 不 可 的 是 ， 这 意 
味 着 控制 和 运动 规划 自身 是 无 法 解决 面向 常用 操作 任 
务 的 机 器 人 运动 的 问题 。 

在 本 章 的 最 后 一 节 ， 我 们 来 回顾 一 些 工作 ， 其 将 
控制 和 规划 方法 的 优点 结合 起 来 形成 一 种 方法 ， 以 确 
定 机 器 人 的 和 运动。 这些 工作 旨 在 创造 一 些 避 免 局 部 极 
小 敏感 性 、 且 同时 能 满足 反馈 要 求 的 方法 。 早 期 的 控 
制 与 规划 相 结 合 的 尝试 可 追溯 到 20 世纪 90 年 代 初 。 
并 不 是 所 有 的 工作 都 与 操作 直接 相关 ， 但 多 数 都 包含 
了 与 这 个 主题 相关 的 内 容 。 在 本 节 中 ， 我 们 回顾 这 些 
工作 ， 并 讨论 一 些 较 新 的 旨 在 集成 运动 规划 和 反馈 控 
制 的 研究 工作 。 

运动 规划 (第 5 章 ) 和 运动 控制 (5863€) fe 
统 上 被 视 为 两 个 截然 不 同 的 研究 领域 。 然 而 ， 这 些 领 
域 有 许多 共同 的 特点 。 这 两 个 领域 都 关注 机 器 人 机 构 
的 运动 、 更 重要 的 规划 和 控制 方法 ， 都 要 确定 出 机 咒 
人 状态 与 机 器 人 运动 的 映射 关系 。 反 馈 控 制 方法 ， 采 
用 在 一 定 状态 空间 区 域 中 定义 势 函 数 的 表示 方法 。 在 
某 个 状态 上 势 函 数 的 梯度 代表 了 运动 命令 。 相 反 ， 运 
动 规划 方法 ， 则 确定 出 运动 的 计划 。 这 些 运动 规划 方 
法 也 将 运动 表示 为 状态 的 集合 。 

运动 规划 和 反馈 控制 ， 在 某 些 方面 也 各 不 相同 。 
与 运动 控制 器 相 比 ， 和 运动 规 划 顺 通常 对 环境 的 要 求 更 
强 ， 具 有 评 佑 环境 状态 及 其 可 能 出 现 变 化 的 能 力 。 运 
动 规划 也 要 求 在 已 知 当前 状态 和 特定 动作 时 、 机 融 人 
的 状态 能 映射 到 未 来 某 个 状态 的 能 力 。 鉴 于 这 种 能 力 
和 关于 环境 的 全 局 信息 ， 运 动 规 划 器 能 确定 出 不 易 陷 
人 局 部 极 小 的 运动 。 然 而 ， 运 动 规划 器 积极 的 一 面 却 
导致 计算 成 本 的 显著 增加 〈 见 第 5 章 ) 。 规 划 和 控制 
对 计算 要 求 的 巨大 差别 ， 以 及 所 导致 运算 技术 的 不 
同 ， 可 能 是 目前 这 两 个 领域 分 收 的 主要 原因 。 人 研究 人 
员 正 尝试 通过 设计 规划 和 控制 的 统一 理论 来 逆转 这 种 
分 歧 。 


26.5.1 反馈 运动 规划 


反馈 运动 规划 是 将 规划 和 反馈 结合 起 来 的 一 种 运 
动 策略 。 规 划 需 考虑 全 局 信息 来 计算 不 受 局 部 极 小 影 


响 的 反馈 运动 规划 方案 。 这 种 反馈 运动 规划 方案 可 以 
表示 为 一 个 势 场 函数 或 向 量 场 ， 其 梯度 信息 可 以 使 机 
器 人 从 状态 空间 的 任何 可 达 部 分 到 达 目 标 状态 *"*。 
无 局 部 极 小 的 势 场 函数 也 称 为 导航 函数 "已 
知 机 器 人 的 当前 状态 和 全 局 导航 函数 ， 反 馈 控制 可 以 
用 来 确定 机 右 人 的 运动 。 在 全 局 导航 函数 中 考虑 机 器 
人 状态 的 反馈 ,减少 了 对 传 感 和 驱动 的 不 确定 因素 的 
敏感 性 。 

反馈 运动 规划 ,原理 上 可 以 处 理 所 有 的 运动 约 
束 及 其 反馈 要 求 ( 见 图 26. 3)。 假设 全 局 导航 函数 
考虑 了 所 有 的 约束 ， 由 于 反馈 运动 规划 已 经 为 所 有 
状态 空间 给 出 了 理想 的 运动 命令 ,反馈 的 要 求 很 容 
易 得 到 满足 。 显 然 ， 反馈 运动 规划 的 主要 挑战 是 这 
种 导航 函数 或 反馈 运动 规划 的 计算 量 问 题 。 对 执行 
操作 任务 ， 这 个 问题 变 得 尤其 困难 ， 因 为 机 器 人 每 
次 抓 取 或 释放 环境 中 的 物体 ( 见 26.3 节 ) ， 状 态 空 
间 (或 构 型 空间 ) 都 要 变化 。 这 种 变化 要 求 重新 计 
算 反馈 运动 规划 方案 。 在 动态 环境 中 ， 障 碍 物 的 运 
动 总 使 计算 好 的 反馈 运动 规划 方案 失效 ， 也 需要 频 
繁 地 重新 计算 。 

在 本 节 的 剩 下 部 分 ， 我 们 来 回顾 计算 导航 函数 
的 各 种 方法 。 通 常 来 说 ， 有 效 计算 面向 操作 任务 的 
反馈 运动 规划 的 问题 尚未 得 到 解决 。 因 此 ， 我 们 所 
介绍 的 方法 并 不 是 明确 针对 操作 任务 的 。 这 些 方法 
可 以 分 为 三 类 : 中 精确 方法 ; 四 基于 动态 规划 的 近 
似 方法 ; 加 基于 更 简单 势 场 函数 的 构造 和 排序 的 近 
似 方法 。 

最 早 的 计算 导航 函数 的 精确 方法 适用 于 特定 形 
TR Be AERP BY) fi) BL gO) 。 基 于 离散 空间 (网 
He) 的 近似 方法 可 以 克服 这 一 局 限 性 ， 但 提出 了 状 
态 空间 维 数 指数 级 计算 复杂 度 的 难题 。 这 些 近 似 导 
航 函 数 称 为 数值 导航 函数 '*"。 这 些 导 航 函数 通常 
应 用 在 移动 机 器 人 上 。 由 于 移动 机 器 人 具有 低 维 构 
型 空间 ， 这 些 方法 通常 可 以 鲁 棒 且 有 效 地 解决 运动 
规划 的 问题 。 

一 些 物理 过 程 ， 如 热传导 或 液体 流动 ， 可 以 描述 
为 一 种 特定 类 型 的 微分 方程 ， 称 为 调和 函数 。 这 些 函 
数 具有 适合 作为 导航 函数 的 特性 "5"”。 最 常 采 用 
近似 、 和 迭代 的 方法 来 计算 基于 调和 函数 的 导航 函数 。 
相对 于 简单 的 数值 导航 函数 ， 和 迭代 计算 的 要 求 增加 了 
计算 成 本 天 2 。 

更 新 的 数值 导航 函数 的 计算 方法 考虑 了 可 极 大 降 
低 计算 成 本 的 微分 运动 约束 20。 这些 方 法 基于 传 
统 的 数值 动态 规划 技术 和 数值 优化 控制 。 然 而 ， 尽 管 
这 些 方法 减少 了 计算 的 复杂 度 ， 其 计算 成 本 仍然 过 
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高 ， 难 以 适用 于 动态 环境 中 的 多 个 自由 度 的 操作 
任务 。 

也 可 以 通过 基于 全 局 信息 而 构造 局 部 势 场 函 数 ， 
来 计算 导航 函数 。 如 图 26. 21 所 示 ， 目 标 是 计算 整个 
构 型 空间 C 中 的 导航 函数 。 这 通过 对 重生 漏斗 的 排 
序 完成 。 每 个 漏斗 代表 一 个 简单 的 局 部 势 场 函 数 。 沿 
着 这 个 势 场 函 数 的 梯度 ， 确 定 出 构 型 空间 子 集 的 运动 
命令 。 如 果 漏 斗 排序 正确 ， 局 部 漏斗 的 合集 能 产生 一 
个 全 局 反馈 规划 。 这 种 反馈 规划 可 以 看 做 一 个 混杂 系 
统 *"， 其 中 漏斗 序列 代表 了 离散 过 渡 结 构 ， 而 每 
个 独立 控制 器 工作 在 连续 域 。 该 漏斗 的 合集 即 是 规 
划 。 在 规划 中 考虑 全 局 信息 ， 可 确定 出 能 避免 陷入 局 
部 极 小 的 漏斗 合集 


[s] 


Bl 26.21 构造 漏斗 形成 导航 函数 


Choi 等 人 1* ”| 提出 了 一 种 基于 局 部 漏斗 的 全 局 
合集 的 早期 方法 。 在 这 种 方法 中 ， 机 器 人 状态 空间 分 
解 成 凸 区 域 。 分 析 这 些 区 域 的 连接 性 可 以 确定 出 关于 
状态 空间 的 全 局 信息 。 这 些 信息 可 以 用 来 与 状态 空间 
中 每 个 凸 区 域 的 简单 局 部 势 场 函 数 相 结合 ， 构 造 出 避 
免 陷 入 局 部 极 小 的 势 场 函数 。 也 提出 了 基于 这 个 想法 
的 更 严格 的 方法 。 这 些 方法 可 以 考虑 机 器 人 的 动力 学 
PARTE MIS AHS PI) 。 但 是 这 些 方法 只 适用 于 
低 维 状 态 空间 ， 不 易 应 用 于 操作 任务 。 

随机 邻居 图 ':*'”*1 是 一 种 基于 采样 的 计算 整个 状 
态 空 间 分 解 的 方法 。 如 前 ， 可 通过 分 析 分 解 域 的 全 局 
连接 性 并 为 每 个 子 域 赋予 充分 的 局 部 势 场 函 数 ， 来 计 
算 导 航 函 数 。 针 对 多 边 形 环 境 中 的 平面 机 器 人 ， 参 考 
文献 [26. 127] 采用 同样 原理 提出 了 一 种 专用 方法 。 
构造 局 部 势 场 函数 的 想法 也 被 成 功 应 用 到 复杂 的 机 器 
人 控制 任务 上 '*'*]。 最 后 ， 参 考 文献 [26.129] 针 
对 构 型 空间 的 圆柱 代数 分 解 ， 提 出 了 一 种 计算 光滑 反 
馈 规划 的 通用 而 有 效 的 方法 。 

构 型 空间 维 数 的 增加 ， 使 得 整个 构 型 空间 上 导航 
函数 的 计算 成 为 棘手 的 问题 。 为 攻克 这 个 难题 ， 特 别 
是 在 自主 移动 操作 时 ， 利 用 工作 空间 的 启发 信息 可 以 
有 效 确 定 出 导航 函数 。 这 个 导航 函数 并 不 包括 整个 构 


型 空间 ， 而 只 是 那些 与 运动 问题 相关 的 需要 启发 式 确 
定 的 区 域 *”™1。 这 种 产生 反馈 规划 的 方法 能 够 满足 
各 种 不 同 的 运动 约束 ， 及 其 相应 的 反馈 要 求 ， 如 图 
26.3 所 示 。 


26.5.2 ”增强 反馈 全 局 规划 


26. 3 节 所 介绍 的 操作 规划 技术 不 容易 陷入 局 部 
极 小 ， 因 为 该 方法 考虑 了 全 局 状态 空间 信息 。 由 于 考 
虑 全 局 信息 导致 了 计算 的 复杂 性 ， 使 得 这 些 规划 技术 
无 法 满足 操作 任务 的 反馈 要 求 。 但 是 ， 对 全 局 运动 所 
要 求 的 反馈 频率 很 低 : 构 型 空间 全 局 连接 性 的 变化 频 
率 很 低 ( 见 图 26.3) 。 因 此 ， 有 可 能 为 全 局 运动 考虑 
规划 需 能 够 接受 的 低频 反馈 ， 而 为 其 他 运动 约束 考虑 
更 高 频率 的 反馈 。 为 了 实现 这 一 目标 ， 必 须 通过 能 根 
据 环境 反馈 逐步 修改 全 局 规划 的 反应 式 部 分 ， 使 全 局 
运动 得 到 增强 。 只 要 由 规划 所 表示 的 全 局 连接 信息 仍 
然 有 效 ， 逐 步 修改 就 能 够 确保 满足 所 有 其 他 的 从 任务 
要 求 到 反应 式 避 障 的 运动 约束 。 

弹性 条 (elastic band) 框架 于 2 增强 了 具有 反 
应 式 避 障 的 全 局 规划 。 由 规划 器 确定 的 全 局 构 型 空间 
路 径 ， 包 含 了 局 部 势 场 函数 ， 每 个 函数 都 可 以 由 路 径 
周围 的 障碍 物 的 局 部 分 布 情况 得 到 。 这 些 局 部 势 场 可 
以 使 路 径 产 生变 形 ， 以 保持 到 障碍 物 的 最 小 距离 。 直 
观 地 ， 路 径 就 像 一 个 弹性 条 ， 障 碍 物 的 运动 使 之 变 
形 。 局 部 势 场 函数 和 全 局 路 径 ， 可 以 看 做 构 型 空间 中 
一 个 局 部 区 域 的 导航 函数 。 与 全 局 规划 顺和 重新 规划 
器 集 成 在 一 起 ， 弹 性 条 框架 允许 实时 避 障 而 不 陷入 局 
部 极 小 。 然 而 ， 全 局 运动 的 反馈 频率 仍然 受到 全 局 规 
划 器 的 限制 。 具 体 任务 的 约束 并 没有 被 纳入 到 弹性 条 
框架 ， 因 此 ， 其 在 操作 任务 中 的 应 用 受到 限制 。 

在 其 初始 方法 中 ， 弹 性 条 框架 假定 机 器 人 的 所 有 
自由 度 是 完整 的 。 一 种 扩展 方法 是 增强 了 有 反应 部 分 
的 非 完整 平 台 的 运动 路 径 * ”1 。 

弹性 带 (elastic- strip) 框架 四 也 增强 了 有 反 
应 式 避 障 的 全 局 运动 规划 方法 。 然 而 ， 除 了 反应 式 避 
障 ， 弹 性 带 框架 可 以 包含 任务 约束 。 与 弹性 条 相似 ， 
弹性 带 包括 有 局 部 势 场 函 数 的 全 局 路 径 。 与 弹性 条 框 
架 不 同 ， 这 些 势 场 函数 是 基于 任务 级 的 控制 器 (IL 
26.2 节 ) ， 因 此 在 修改 全 局 路 径 时 能 保持 任务 一 致 。 
因此 ， 弹 性 带 框架 非常 适合 于 动态 环境 下 的 操作 规划 
的 执行 。 只 要 其 底层 规划 所 描述 的 全 局 信息 是 有 效 
的 ,一 个 弹性 带 会 被 逐步 修改 ， 来 表示 一 个 约束 一 致 
的 轨迹 。 弹 性 带 框 架 已 经 应 用 到 一 个 移动 机 械 手 平台 
的 各 种 操作 任务 中 。 将 弹性 条 和 弹性 带 框架 扩展 ， 形 
成 了 弹性 路 图 (elastic roadmap) 方法 ， 其 结合 了 反 


156 第 4 篇 


操作 与 接口 


应 式 任务 级 的 控制 和 高 效 的 全 局 运动 规划 “1 A 
性 路 图 是 一 个 任务 级 控制 器 的 混杂 系统 ， 任 务 级 控制 
器 由 导航 函数 构成 ， 因 此 满足 图 26.3 所 描述 的 运动 
约束 及 其 相应 的 反馈 要 求 。 


结论 与 扩展 阅读 


20.0 


本 章 概述 了 与 机 器 人 操作 任务 相关 的 生成 运动 和 
控制 策略 。 考 虑 了 运动 的 不 同时 间 尺 度 下 机 器 人 与 环 
境 接 口 的 建 模 问题 ， 集 成 传 感 和 反馈 问题 。 操 作 规划 
作为 基本 运动 规划 问题 的 一 个 扩展 ， 可 建 模 为 在 环境 
中 抓 取 和 移动 零件 动作 而 生成 的 连续 构 型 空间 的 混杂 


并 不 成 立 ， 如 仿 人 机 器 人 (第 56 章 )。 这 些 机 器 人 
可 以 由 多 个 分 支 运动 链 构 成 。 例 如 ， 如 果 我 们 假设 仿 
人 机 器 人 的 躯干 为 机 器 人 的 基础 ， 那 么 腿 ， 胎 膊 ， 和 
头 部 表示 连接 在 基础 上 的 5 个 运动 链 。 如 果 这 种 机 构 
不 包含 任何 封闭 的 运动 环 ， 我 们 将 其 称 为 分 支 机 构 。 
由 分 支 机 构 执 行 的 操作 任务 可 以 对 这 些 分 支 中 的 任何 
一 个 操作 点 提出 要 求 ， 例 如 ， 在 腿 运 动 时 手 可 以 实现 
操作 任务 ， 头 部 可 以 保持 面向 待 操作 物体 的 可 视 
方向 。 

操作 空间 框架 已 扩展 至 分 支 机构 的 任务 级 控 
HACC) 。 这 个 扩展 结合 了 操作 点 和 相关 的 雅 可 比 ， 
计算 包括 所 有 操作 点 的 操作 空间 惯性 和 矩阵。 可 以 采用 


系统 。 通 过 分 析 接 触 状 态 和 柔顺 运动 控制 ， 讨 论 了 装 
配 运 动 的 重要 例子 。 如 26. 2 节 所 述 ， 可 以 实现 串联 
机 械 手 的 操作 点 的 位 置 和 力 控 制 。 在 这 个 方向 提出 了 
很 多 扩展 方法 ， 扩 展 到 同时 多 个 点 的 情形 ， 合 作 操作 
场景 ， 和 分 支 运 动 链 。 对 于 操作 规划 ， 扩 展 到 抓 取 和 
重新 抓 取 规 划 ， 多 机 需 人 ， 多 个 零件 ， 以 及 考虑 移动 
障碍 物 。 在 本 节 中 我 们 将 简要 讨论 这 些 扩 展 ， 并 给 出 
合适 的 参考 文献 。 

1. 通用 接触 模型 

已 证 明 由 Raibert 和 Craig ™® 13 描述 的 混合 力 / 
运动 控制 有 一 定 缺 点 *”]。 在 操作 空间 控制 时 ， 
一 种 动态 解 看 的 力 /运动 控制 的 通用 接触 模型 ， 可 
以 克服 这 些 问题 “'”| 。 这 种 通用 接触 模型 已 经 扩 
展 到 柔顺 运动 控制 框架 ,实现 非 刚性 环境 中 多 个 
接触 点 的 力 控制 *"” ， 以 及 一 个 运动 链 上 不 同 连 
杆 的 多 个 接触 点 的 力 控制 ”1 。 面 向 任务 级 控制 
的 操作 空间 框架 已 应 用 于 复杂 动态 环境 的 实时 仿 
ESIS 。 将 环境 中 物体 之 间 的 接触 点 建 模 为 操作 
点 ， 形 成 了 一 个 求解 移动 体 的 外 力 和 接触 约束 的 
简洁 的 数学 框架 。 

2. 合作 操作 控制 

如 果 多 个 任务 级 控制 的 机 器 人 协作 来 操作 一 个 
物体 ， 它 们 通过 与 物体 连接 而 形成 一 个 封闭 的 运动 
链 。 整 个 系统 的 动力 学 ， 可 以 采用 一 个 增强 物体 的 
概念 来 描述 ”wl ， 基 中， 机械 手 和 物体 的 动力 
学 结合 起 来 形成 一 个 整体 系统 的 模型 。 运 动 过 程 中 
在 抓 取 点 处 产生 的 内 力 ， 可 采用 虚拟 链 框 架 的 方法 
HEITER, BAHR [26.142-148] 提出 了 
操作 空间 框架 外 的 多 机 器 人 合作 操作 的 一 些 其 他 
策略 。 

3. 分 支 机 构 的 控制 

至 今 ， 我 们 默认 假定 任务 控制 机 器 人 是 由 一 个 单 
独 的 运动 链 组 成 。 这 种 假设 在 更 复杂 的 运动 学 机 构 中 


实际 上 与 操作 点 数目 成 线性 的 算法 ， 有 效 地 计算 出 这 
"AE NE 

4. 非 完整 移动 操作 

所 有 以 前 讨论 过 的 任务 级 控制 的 工作 都 假定 自由 
度 是 完整 的 。 对 于 机 械 手 辟 ， 这 通常 是 一 个 有 效 的 假 
设 。 然 而 ， 对 于 最 常见 的 移动 平台 ， 其 基于 差分 驱 
动 ， 或 同步 驱动 ， 或 梯形 转向 (指向 一 面 ) ， 所 有 这 
些 都 受到 非 完 整 约束 。 操 作 空 间 框 架 已 经 扩展 到 移动 
操作 平台 ， 其 结合 了 非 完 整 移动 平台 与 一 个 完整 的 机 
PCO PY ， 可 实现 一 大 类 的 移动 操作 平台 的 任 
务 级 控制 。 

5. 不 确定 模型 的 学 习 

操作 空间 控制 的 效果 取决 于 机 器 人 动力 学 模型 的 
准确 性 。 尤 其 在 采用 零 空 间 投影 的 方法 执行 多 个 行为 
时 ， 建 模 误差 会 有 很 大 的 影响 。 为 了 克服 对 准确 动力 
学 模型 的 依赖 性 ， 可 以 采用 强化 学 习 的 方法 学 习 得 到 
dias ap aqu] ABO) 。 

6. 抓 取 和 重新 抓 取 规 划 

在 可 能 解 的 连续 域 中 ， 确 定 保证 完成 操作 任 
务 的 零件 瞬 态 稳定 构 型 ， 以 及 选取 合适 的 抓 取 方 
式 ， 都 是 很 困难 的 问题 。Simeon 56 AU FET 
一 个 考虑 连续 抓 取 和 放置 的 操作 规划 框架 。 然 而 ， 
从 所 有 可 能 的 抓 取 构 型 中 选择 并 确定 何 时 再 抓 取 ， 
仍然 是 一 个 开放 的 研究 问题 。 不 同 抓 取 指 标的 概 
WR, FEJL Miller 和 Allen AY SC BETES | pL 98 
28 Hi, 

7. 多 个 零件 

操作 规划 框架 很 好 地 泛 化 了 多 个 零件 已 ，…， 
P, 的 问题 。 每 个 零件 都 有 自己 的 C 空间，C 空间 是 
所 有 零件 的 C 空间 和 机 械 手 C 空间 的 笛 卡 儿 乘 积 。 
与 Cu 的 定义 方式 相似 ， 但 需要 删 掉 零 件 和 零件 ， 
零件 和 机 械 手 ， 机 械 手 和 障碍 物 ， 以 及 零件 和 障碍 
物 之 间 的 碰撞 空间 。C, 的 定义 要 求 所 有 零件 都 处 


第 26 章 面向 操作 任务 的 运动 157 
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于 稳定 构 型 ， 也 多 许 零件 之 间 重奏 在 一 起 。C。。 的 
定义 要 求 抓 住 一 个 零件 而 其 他 零件 处 于 稳定 构 型 。 
仍然 有 两 种 模式 ， 取 决 于 机 械 手 是 否 抓 住 零 件 。 同 
样 ， 过 渡 空 间 仅 出 现在 机 器 人 处 于 Ci = Coote N 
E iu 

8. 多 机 器 人 规划 

将 方法 泛 化 到 上 个 机 器 人 会 产生 2k 种 模式 ， 
其 中 每 种 模式 表示 每 个 机 器 人 是 否 抓 住 一 个 零 
件 。 甚 至 允许 多 机 器 人 抓 住 同一 个 零件 ， 这 产生 
了 一 个 封闭 运动 链 和 合作 运动 的 有 趣 的 规划 问题 
(SLSR 29 章 ) , Koga 2 解决 了 多 手臂 操作 规划 
问题 ， 必 须 由 几 个 操作 手臂 抓 住 和 移动 同一 个 物 
体 。 另 一 种 泛 化 是 允许 一 个 机 器 人 同时 抓 住 多 个 
零件 。 

9. 封闭 运动 链 的 规划 

当 多 机 器 人 抓 住 同一 个 零件 ， 甚 至 一 个 手 的 
多 个 手指 抓 住 同 一 个 零件 时 ,保持 运动 链 的 封闭 
TE, 产生 了 5C 的 子 空间 ( 见 第 15 章 ) 。 因 为 参数 
化 方法 不 可 行 ， 这 种 情况 下 的 规划 要 求 路 径 保持 
低 维 变化 。 规 划 并 联机 构 或 其 他 有 环 路 系统 的 运 
动 时 ， 通 常 要 求 同 时 保持 多 个 封闭 的 约束 (第 
12 章 ) 。 

10. 有 移动 障碍 物 时 的 规划 

在 一 些 情况 下 ， 人 允许 机 器 人 重新 放置 环境 中 的 障 
碍 物 ， 而 不 仅仅 是 简单 地 躲避 它们 。Wilong' °°) 首 
次 解决 了 存在 移动 障碍 物 的 运动 规划 问题 。Wilfong 
证 明了 该 问题 是 PSPACE 难题 ， 即 使 在 所 有 移动 物体 
的 目标 位 置 都 给 定 的 二 维 环境 中 。Erdmann 和 Lozano- 
Perez! ™® 考虑 了 多 个 运动 物体 的 协调 规划 。4la- 
mi 给 出 了 针对 一 个 机 器 人 和 一 个 移动 物体 的 通 
用 算法 ,将 抓 取 构 型 空间 构造 成 有 限 的 单元 。Chen 
和 Hwang ™® H 提出 了 一 个 圆 形 机 器 人 的 规划 器 ， 可 
以 在 移动 时 将 物体 推 到 一 边 。Stilman 和 Kuffner 考虑 
T SH LX] 09 197 和 操作 规划 所 2 的 移动 障碍 物 问 
A. Nieuwenhuisen 等 245 史 开 发 了 存在 移动 障碍 物 的 
规划 的 通用 框架 。 

11. 非 抓 取 操 作 

Lynch 和 Mason” 探索 了 将 抓 取 操作 替换 为 推 
动 操 作 的 一 些 场景 。 固 定 的 推动 方向 为 机 器 人 运动 带 
来 了 非 完 整 约束 ， 并 产生 了 与 可 控 性 相关 的 问题 。 加 
工 和 装配 过 程 的 零件 送 进 机 构 和 操作 ， 也 有 相关 的 问 
题 (第 42 章 ) 。 

12. 装配 运动 扩展 

本 章 中 介绍 的 装配 运动 的 工作 集中 在 刚性 零件 
的 装配 上 ， 所 考虑 的 零件 通常 是 多 面体 或 简单 的 非 


aj 


多 面体 形状 ， 如 圆 轴 和 和 孔 。 最 近 的 关于 曲面 物体 接 
触 状态 分 析 的 工作 ， 见 参考 文献 [26. 166]。 装 配 
的 一 个 新 兴 领 域 是 微 /纳米 装配 (第 18 HE), FEE 
或 可 变形 零件 的 装配 逐渐 引起 关注 乓 9 。 针 对 
仿真 和 原型 的 虚拟 装配 *" ， 也 是 一 个 有 趣 的 研究 
领域 。 
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第 27 革 接触 环境 的 建 模 与 作业 


Imin Kao, Kevin Lynch, Joel W. Burdick 
张 立 勋 YE 


机 械 手 通过 接触 力 实现 对 所 处 环境 中 的 物体 进 
行 抓 持 和 操作 。 夹 持 器 通过 接触 来 定位 工件 。 移 动 
机 器 人 和 仿 人 机 器 人 通过 轮 或 足 来 产生 接触 力 ， 以 
实现 移动 。 对 接触 面 进行 建 模 是 对 诸多 机 器 人 作业 
任务 进行 分 析 、 设 计 、 规 划 和 控制 的 基础 。 

本 章 对 接触 面 的 建 模 进行 了 概述 ， 并 对 诸如 推 
操作 等 无 法 抓 持 或 不 适 于 抓 持 操作 的 作业 任务 的 应 
] 进 行 了 着 重 描述 。 抓 取 和 夹 持 动作 的 分 析 和 设计 
也 是 基于 对 接触 环境 的 建 模 ， 详 细 介 绍 可 参见 第 
28 章 。 

27.2 节 至 27.5 节 主 要 介绍 了 刚体 接触 环境 的 
建 模 。 其 中 ，27. 2 节 介 绍 了 由 接触 引起 的 运动 约 
R, 27.3 节 介 绍 了 由 接触 力 引起 的 库仑 摩擦 力 。 
27.4 节 提 供 了 考虑 刚体 接触 和 库仑 摩擦 力 时 的 多 
接触 操作 任务 方面 的 实例 分 析 。27.5 节 将 分 析 内 
容 扩 展 至 推送 操作 。27.6 节 介 绍 了 接触 面 的 建 模 、 
运动 学 对 偶 性 和 压力 分 布 。27.7 节 介 绍 了 摩擦 限 
定 面 的 概念 ， 并 通过 如 何 创建 软 接触 约束 面 的 例子 
加 以 说 明 。 最 后 ，27. 8 节 讨 论 了 这 些 精 确 的 模型 
在 夹 持 器 的 分 析 和 设计 中 的 应 用 。 


27.1 WER HH] 163 
27.1.1. 接触 环境 模型 的 选择 ………………… 163 
27.1.2. 抓 持 作业 的 分 析 PP 164 


27.1 概述 


接触 环境 模型 的 特性 是 : 力 可 通过 相互 接触 的 物 
体 实现 传递 ， 而 且 相 互 接触 的 物体 也 可 实现 相对 运 
动 。 这 些 特性 取决 于 相互 接触 物体 的 接触 表面 几何 特 
性 以 及 物体 的 材料 特性 ， 也 决定 着 摩擦 力 和 接触 变形 
的 大 小 。 


27.1.1 接触 环境 模型 的 选择 


接触 环境 模型 的 选择 主要 取决 于 研究 的 内 容 或 应 
用 场合 。 当 采用 精确 的 分 析 模 型 时 ， 研 究 者 必须 清 


27.2 刚体 接触 运动 学 pp 164 
27.2.1 接触 约束 … 165 
27.2.2 多 接触 体 的 综合 MM 166 
27.2.3 平面 图 解法 … ee 166 

27.3. JJAUEETRJ] e e e HR 167 
27.3.1 平面 图 解法 Ded teui ua: SOR. seats deve dis DA ud 168 
27.3.2 ”接触 扭矩 和 扭转 自由 度 的 对 偶 性 …… 168 

27.4 考虑 摩擦 时 的 刚体 力学 169 
21.4.1 互补 性 E A I E tists av DU DS CUN dut 170 
FAL WAAR E teens 170 
21.4.3 示例 ss T aute duda ahciatsie’ ois sro ea a UR aet ate Ria 170 

27.5 djÉEMERIE- MM 172 

27.6 Sh AE HEB eM 173 
27.6.1 接触 面 建 模 和 173 
27.6.2 FE fe AS geeeeeMMMRRHHRHRRR 174 

27.7 ” 摩 扩 限定 面 ee MM 174 
27.7.1. 在 软 接触 面 上 的 摩擦 限定 面 ………… 175 
27.7.2 ERRIRE HJIR] 176 

27.8 IRK RE RA ………… 177 
27.8.1 软 指 的 接触 刚度 M 177 
27.8.2 软 接触 理论 在 夹 持 器 设计 中 的 

应 用 i ededee 178 

27.0 ”结论 与 扩展 阅读 pp 178 
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楚 ， 操 作 规划 或 夹 持 器 设计 时 的 功能 要 求 是 否 在 该 模 
型 的 限定 范围 内 。 

1. 刚体 模型 

操作 、 抓 持 和 夹 持 器 的 分 析 等 诸多 方面 的 问题 都 
以 刚体 的 模型 为 基础 。 在 刚体 模型 中 ， 两 个 相互 接触 
刚体 的 接触 点 或 接触 面 之 间 不 允许 存在 变形 。 反 过 
来 ， 接 触 力 有 两 个 来 源 ， 刚体 的 不 可 压缩 和 不 可 穿 透 
特性 的 约束 ， 以 及 表面 摩擦 力 。 
刚体 模型 易于 使 用 ， 有 利于 规划 算法 的 运算 以 及 
与 实体 建 模 软件 系统 的 兼容 。 刚 体 模 型 通常 可 用 于 回 
答 定性 问题 ， 例 如 : 这 个 夹 持 器 能 拿 起 我 的 工件 吗 ? 
该 模型 还 可 用 来 解决 刚体 间接 触 力 缓冲 问题 。 
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然而 ， 刚 体 模型 并 不 能 用 来 描述 所 有 范围 内 的 
接触 现象 ， 例 如 : 对 于 一 个 多 接触 夹 持 器 来 说 ， 刚 
体 模型 无 法 预测 其 单 接触 力 的 大 小 (项 不 定 问 
RPT) 。 此 外 ， 对 于 存在 较 大 夹 持 力 的 加 工 操作 
来 说 ， 夹 持 器 中 物体 的 变形 是 不 可 忽略 的 >” 。 这 
些 严重 影响 加 工 精 度 的 变形 无 法 由 刚体 模型 获得 。 
同样 ， 对 于 存在 库仑 摩擦 力 的 刚体 模型 会 引起 力学 
问题 ， 且 没有 什么 解决 方法 年 。 为 了 克服 刚体 
模型 中 存在 的 这 些 局 限 性 ， 必 须 在 接触 环境 模型 中 
引入 柔顺 。 

2. 柔性 模型 

柔性 体 的 变形 是 由 所 施加 的 力 引 起 的 。 接 触 环境 
的 相互 作用 力 是 由 柔性 或 刚性 模型 推导 出 来 的 ， 然 而 
和 柔性 接触 模型 显得 更 加 复杂 ， 并 具有 诸多 优势 : 该 模 
型 可 以 解决 刚体 模型 回 有 的 静 不 定 问 题 ， 并 且 可 以 预 
测 抓 取 或 夹 持 需 在 加 载 过程 中 的 变形 情况 。 

实际 材料 变形 的 具体 模型 是 十 分 复杂 的 。 因 此 ， 
为 了 分 析 方 便 ， 我 们 经 常 采 用 具有 有 限 变 量 数目 的 
集中 参数 或 降 阶 的 柔性 模型 。 本 章 将 介绍 一 种 降 阶 
的 准 刚体 法 来 建立 模型 的 方法 ， 该 建 模 方法 与 固体 
力学 理论 ， 传 统 机 器 人 分 析 及 规划 模式 是 一 致 的 ， 
可 用 于 多 种 柔性 材料 的 建 模 。 

最 后 ， 采 用 三 维 有 限 元 模型 “或 相似 的 理 
念 ” ”中 来 分 析 夹 持 器 中 工件 的 变形 和 应 力 。 当 要 
求 精确 时 ， 这 些 数 值 分 析 方 法 就 会 存在 缺陷 ， 例 如， 
对 于 抓 取 的 刚度 矩阵 只 能 通过 复杂 困难 的 数值 方法 来 
建立 。 刚 度 矩 阵 是 经 常用 来 计算 质量 的 方法 ， 是 实现 
优化 抓 取 动作 规划 及 夹 持 器 设计 的 依据 ”2 ， 所 
以 数值 分 析 方 法 更 适合 各 种 未 端 夹 持 需 的 设计 。 


27.1.2 抓 持 作业 的 分 析 


接触 环境 模型 一 旦 选 定 ， 可 以 应 用 该 模型 来 分 析 
涉及 多 接触 面 的 作业 情况 。 如 果 一 个 物体 有 多 个 接触 
面 ， 则 由 自身 接触 引起 的 运动 学 约束 和 自由 度 必 须 整 
体 考 虑 。 这 种 整体 分 析 方 法 有 助 于 操作 的 规划 ， 即 接 
触 位 置 的 选择 ， 以 及 由 这 些 接触 面 可 能 施加 的 运动 和 
力 ， 以 便 完 成 零件 预期 的 动作 。 最 基本 的 范例 是 关于 
抓 取 和 夹 持 的 问题 : 选择 接触 位 置 和 合适 的 接触 力 ， 
以 防止 在 外 界 干扰 下 在 零件 表面 上 产生 的 运动 。 第 
28 章 将 更 加 详细 地 讨论 这 个 问题 。 其 他 的 范例 涉及 
了 部 分 约束 ， 例 如 推拉 一 个 零件 或 者 往 孔 中 搬入 销 钉 
等 问题 。 


27.2 刚体 接触 运动 学 


接触 运动 学 是 关于 在 考虑 刚体 不 可 穿 透 约束 的 情 


况 下 如 何 使 两 个 或 更 多 的 物体 产生 相对 运动 的 ， 其 对 
接触 面 的 运动 分 为 滚动 和 滑动 两 类 。 

考虑 位 置 和 方向 〈 位 姿 ) 都 已 确定 的 两 个 刚体 ， 
分 别 用 局 部 坐标 列 向 量 g, 和 g, 表示 。 其 组 合 形式 记 
We gq = (q1, al)", 定义 两 刚体 间 的 位 置 函 数 为 
d(q): 当 两 刚体 分 离 时 取 正 值 ， 接 触 时 为 零 ， 贯 
穿 时 取 负 值 。 如 果 d(q) >0， 则 刚体 间 的 运动 没 
有 约束 。 如 果 刚 体 相互 接触 (d(q) =0)， 则 要 视 


位 置 函 数 关于 时 间 的 导数 4 d 等 情况 ， 以 便 确 
定 刚 体 是 否 保持 接触 或 者 是 按 自身 遵循 的 运动 轨 
迹 g(1) 分 开 。 该 种 情况 可 以 由 表 27. 1 所 示 的 可 
能 性 来 确定 ; 

只 有 所 有 的 时 间 导 数 均 为 零 时 ， 刚 体 才 一 直 保持 
接触 。 前 两 个 时 间 导 数 记 为 


ad Y 
rd 
d up 的 27.2 
4 apt Vo) * (27.2) 


st, DER IURE T RH FERE MARS JL IUE 


息 。 前 者 对 应 于 接触 的 法 向 ， 而 后 者 则 对 应 于 接触 处 
的 相对 曲率 。 


表 27.1 接触 的 可 能 性 


d d d 

>0 无 接触 

<0 不 会 实现 〈 穿 透 ) 
=0 >0 脱离 接触 

=0 <0 不 会 实现 (FA) 
=0 =0 >0 脱离 接触 

=0 =0 <0 不 会 实现 〈 穿 透 ) 
如 果 一 直 保 持 接触 ， 可 以 把 接触 形式 分 为 滑 


动 和 滚动 两 类 。 与 上 表 所 示 相 似 ， 当 且 仅 当 物 体 
接触 点 间 的 相对 切线 速度 和 加 速度 等 为 零 时 ， 接 
触 形式 才 为 滚动 。 如 果 相 对 切线 速度 不 为 零 ， 则 
接触 物体 为 滑动 ， 如果 相对 速度 为 零 但 相对 切线 
加 速度 或 (更 高 阶 导数 ) 不 为 零 ， 则 只 有 初始 状 
态 为 滑动 。 

本 节 侧 重 于 接触 运动 学 的 一 阶 分 析 。 从 一 阶 分 析 


fi. WR dlg) <0, Hd =0， 则 物体 保持 接触 。 
接触 运动 学 的 局 部 线性 化 集中 于 速度 g 和 接触 法 向 


第 27 章 ”接触 环境 的 建 模 与 作业 165 


0d/9q 上 ,不 考虑 接触 几何 形状 (曲率) 的 高 阶 空间 
导数 。 虽 然 这 是 一 个 很 好 的 开端 ， 不 过 也 可 能 时 而 导 
致 错误 的 结论 。 例 如 ，Rimon 和 Burdick ^79 48 Hy 
如 果 二 阶 分 析 时 显示 物体 实际 上 是 被 完全 约束 时 ， 那 
么 一 阶 分 析 可 能 会 错误 地 预测 零件 在 夹 持 器 中 的 运 
动 性 。 

参考 文献 [27.26] 介绍 了 参数 化 表面 的 滚动 接 
触 运动 学 分 析 ， 也 可 参见 参考 文献 [27. 27-30]。 


27.2.1 接触 约束 


正如 第 1 ER, 空间 刚 体 具 有 6 个 自由 
BE, 这些 自 由 度 由 附着 在 物体 上 的 坐标 系 原点 P 
及 其 相对 固定 于 地 球 的 惯性 坐标 系 0 的 方位 定 
义 。 定 义 "P e R 为 物体 质心 的 位 置 ， 并 定义 
^R,eSO(3) 描述 物体 相对 惯性 坐标 系 0 方向 的 
旋转 矩阵 。 物 体 的 空间 速度 记 作 te R^, tp 
为 旋 量 


— 


t=(@',v')" 
KH, w=(@,, w, w,)", v 2 (v,, v,, v) 分 别 代 
表 局 部 坐标 系 己 在 世界 坐标 系 0 内 的 角速度 和 线 速 
度 ， 并 满足 


°R, =w@x’R, 


v=°P,- wx"°P, 

此 时 ， 花 一 些 时 间 去 真正 理解 刚体 的 空间 速度 是 
必要 的 。 空 间 速度 包括 由 世界 坐标 系 0 表示 的 刚体 
角速度 ， 以 及 当前 位 于 世界 坐标 系 的 原点 并 牢固 地 附 
着 在 物体 上 的 某 点 处 的 线 速 度 。 这 些 点 并 不 需要 位 于 


物体 上 。 换 句 话 说 , v 并 不 简单 地 等 价 于 "P,。 所 有 
速度 和 力 由 世界 坐标 系 0 统一 表示 的 表达 式 将 会 被 
简化 如 下 (请 注意 ， 旋 量 有 时 是 在 局 部 坐标 系 内 定 
义 的 )。 

物体 上 的 点 接触 提供 了 单 向 约束 ， 可 以 阻止 
物体 相对 接触 法 向 的 局 部 移动 。 定 义 x 是 0 坐标 
系 内 的 接触 点 位 置 坐 标 ， 物体 上 接触 点 的 线 速 
度 为 


Ve =Vt@xx 

(为 了 简化 ， 省 略 前 上 角 标 0; 例如 ,"x 简写 作 x.) 
定义 为 指向 物体 的 单位 法 向 量 (ILE 27.1) 。 未 处 
于 单 向 约束 的 物体 为 一 阶 情况 ， 可 以 表示 为 

VU= (vt+wxx) U0 (27.3) 
换 名 话说 ,零件 上 点 C 的 速度 不 可 以 含有 与 接触 法 
向 反 向 的 分 量 。 为 了 用 男 一 种 方式 表达 ， 定 义 广义 的 
治 接触 法 向 的 单位 力 或 扭矩 w， 用 其 合成 作用 在 零件 


EJE m 和 力 f 
w=(m", f")"=[(xxu)", u"]" 
则 式 (27.3) 可 记 作 
tiw=0 (27.4) 
如 果 外 部 约束 点 随 着 线 速度 ws 移动 ， 式 
(27.4) 变更 为 


T TI 
t wv uu 


如 果 是 静止 约束 ， 则 仍 要 采用 式 (27.4) 。 


(27.5) 


图 27.1 与 机 械 手 或 环境 接触 的 物体 的 表示 方法 


诸如 式 (27.5) 形式 的 每 个 不 等 式 会 限制 物体 
的 速度 ， 速 度 被 约束 在 由 fw =v" u EE TER b 
六 维 速度 空间 的 半空 间 。 集 中 所 有 约束 的 集合 ， 
以 获得 可 行 的 物体 速度 的 凸 多 面体 点 集 。 如 果 零 件 
的 半空 间 约束 没有 改变 可 行 速度 多 面体 ， 那 么 该 约 
束 是 宛 余 的 。 对 于 给 定 的 旋 量 :， 如 果 满 足 式 
(27.6) ， 则 约束 为 有 效 的 ; 否则 零件 在 那 一 点 脱离 
接触 。 


fiw = vu (27.6) 

一 般 来 说 ， 物 体 可 行 的 速度 多 面体 包括 内 六 面体 
(没有 接触 约束 是 有 效 的 情况 ) ， 五 维 多 面 体 ， 四 维 
多 面体 ， 一 直到 一 维 边界 和 零 维 点 等 等 。 物 体 在 速度 
多 面体 的 n 维 平面 上 的 速度 表明 6-n 个 独立 (SEIT 
余 ) 约束 是 有 效 的 。 

如 果 所 有 的 约束 条 件 都 是 静止 的 (=0) BU 
每 个 由 式 (27.5) 定义 的 约束 半 平 面 通过 速度 空间 
的 原点 ， 并 且 可 行 速度 集 变 成 根 在 原点 的 锥 面 。 假 设 
WATS i 个 静止 约束 的 约束 扭矩 ， 则 可 行 的 速度 锥 
面 为 : 


V={t\t'w,20 Vit 
如 果 mw, 跨越 六 维 广 义 力 空间 ， 或 者 等 价 地 说 ，wmw, 的 
凸 边界 包含 内 部 原点 ， 那 么 静止 约束 条 件 完 全 约束 零 
件 的 运动 ， 就 具有 了 形 封 闭 ， 正 如 第 28 章 所 讨论 的 
一 样 。 
在 上 面 的 讨论 中 ， 每 一 种 式 (27.5) 的 约束 把 
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物体 的 速度 空间 划分 为 三 类 : 始终 保持 接触 的 速度 超 
平面 ， 使 零件 分 离 的 速度 半 和 平面， 使 零件 产生 穿 透 的 
速度 半 平 面 。 始 终 保持 接触 的 速度 可 进一步 分 为 两 
类 : 物体 在 接触 约束 面 上 作 滑 动 运动 的 速度 ， 物 体 黏 
附 于 接触 约束 面 或 在 接触 约束 面 上 作 滚 动 运动 的 速 
度 。 在 后 面 一 种 情况 下 ， 零 件 速度 满足 3 个 方程 
yY-WXX-VWA CET) 
现在 可 以 赋予 每 个 接触 点 i 一 个 标号 到 以 对 应 其 
接触 类 型 ， 称 为 接触 标号 : 如 果 正 脱离 接触 则 记 为 
b， 如 果 是 固定 的 接触 (包括 滚动 ) 则 称 为 {f， 如 果 
接触 为 滑动 ， 即 满足 式 (27.6) 却 不 满足 式 (27.7) 
则 称 为 s。 整 个 系统 的 接触 模式 可 以 记 作 个 接触 点 
的 级 联接 触 标签 的 形式 ，m m,…m,。 
27.2.2 多 接触 体 的 综合 
上 面 的 讨论 可 以 归结 为 确定 多 物体 接触 的 可 行 速 
度 域 。 如 果 物 体 ; 和 /7 在 点 x 处 接触 ， 在 该 点 ,指向 
FiFi, Hw, e[(xxu)', uw"]"， 则 其 空间 速度 4 
和 必须 满足 式 (27.8) 的 约束 条 件 以 避免 贯穿。 
(ti—t) w=0 (27. 8) 
这 是 一 种 在 (5 -t) 合成 速度 空间 中 的 齐 次 半 
空间 约束 。 在 多 零件 的 组 件 中 ， 每 两 两 接触 会 在 组 合 
零件 的 速度 空间 中 产生 额外 的 约束 ， 其 结果 是 一 个 在 
运动 学 上 可 行 的 多 面体 速度 凸 锥 ， 并 且 其 根 位 于 合成 
速度 空间 的 原点 。 整 体 组 件 的 接触 模式 是 在 组 件 内 每 
个 接触 点 接触 标签 的 级 联 形式 。 
如 果 存 在 指定 运动 形式 的 移动 接触 ， 例 如 机 械 手 
和 ， 关 于 其 他 部 件 的 运动 约束 不 会 再 是 齐 次 的 。 所 以 
凸 多 面体 可 行 速度 空间 不 再 是 根 在 原点 的 锥 面 。 


27.2.3 平面 图 解法 


当 物体 被 限制 在 x-y 平面 内 移动 , 旋 量 上 还 
BUS: 
t= (o,, ,, 
点 (一 /@.，V./w,) 被 称 为 投影 平面 内 的 旋转 中 心 
(CoR) ， 任 何平 面 旋 量 都 可 由 它 的 旋转 中 心 和 旋转 速 
度 w. 表 示 ，( 请 注意 ， 必 须 小 心 对 待 w, =0 的 情况 ， 
它 对 应 旋转 中 心 在 无 穷 远 的 情况 。) 这 有 时 对 图 解法 
有 帮助 : 对 于 被 静止 夹 持 器 约束 的 单一 物体 ， 至 少 可 
以 画 出 其 可 行 的 旋 量 锥 面 作为 旋转 中 心 "|。 
作为 一 个 例子 ， 图 27. 2a 展示 了 一 个 置 于 桌面 上 
并 由 机 械 手指 约束 的 平面 零件 。 该 机 械 手 指 当 前 是 静 
JENS, 但是， 在 后 文中 会 让 手指 运动 起 来 。 机 械 手 指 
对 零件 的 运动 定义 了 一 种 约束 ， 桌 面 则 定义 了 另外 两 


T T 
O, Va, V}, v.) -(0, 0, Oz, V,, Vy, 0) 


个 约束 。( 请 注意 ， 零 件 和 桌面 间 的 内 部 边界 上 的 接 
触 点 提供 了 宛 余 的 运动 学 约束 。) 约束 扭矩 可 以 
写成 : 


w, =(0,0, -1,0, 1,0)' 

w,-2(0,0,1,0,1,0)" 

w,=(0,0,1, =1, 0,0)" 
对 于 静止 的 机 械 手 指 ， 其 运动 学 约束 产生 可 行 的 旋 量 
锥 面 ， 如 图 27. 2b 所 示 。 采 用 以 下 方法 也 可 以 很 容易 
地 使 该 区 域 在 平面 内 可 视 化 : 在 每 个 接触 处 ， 画 出 接 
触 法 向 线 。 在 所 有 法 向 上 的 点 标记 + 上 ， 指 向 内 法 向 左 
侧 的 为 “+”， 指 向 内 法 向 右 侧 的 为 “-”。 在 没有 
违背 接触 约束 的 条 件 下 ， 对 于 所 有 的 接触 约束 ， 所 有 
标记 为 + 的 点 可 以 看 做 旋转 中 心 具 有 正 的 角速度 ， 则 
所 有 标记 为 - 的 点 可 以 看 做 旋转 中 心 具 有 负 的 角 速 
度 。 当 对 所 有 的 接触 法 向 采用 了 上 述 处 理 后 ， 只 保证 
旋转 中 心 一 致 性 的 被 标记 。 这 些 旋 转 中 心 是 可 行 旋 量 
锥 面 的 平面 表示 方法 ， 如 图 27. 2c 所 示 。 


a) i b) 


| sisib 
bap 在 无 穷 远 处 


bbs, srbsr 
| 


sisib 
| 在 无 穷 远 处 
c) d) 


图 27.2 
b) 捏 矩 锥 面 满足 接触 约束 ,用 与 零件 接触 的 约束 平面 表 


a) 置 于 桌面 上 的 具有 三 个 接触 约束 的 零件 


示 接 触 法 向 
意 ,向 左 和 向 底部 向 外 延伸 的 线 在 无 穷 远 处 回 绕 ,并 分 别 
从 右 侧 和 顶部 回来 ,所 以 CoR 区 域 应 该 被 理解 为 单独 接 
触 的 凸 区 域 ,等 价 于 图 pb 所 示 的 扭矩 锥 面 d) 为 每 个 可 行 
运动 标记 接触 符号 ,速度 为 零 的 接触 符号 是 二 


c) CoR 的 等 价 表 示 方 法 ,用 灰色 表示 。 请 注 


通过 为 每 个 可 行 的 CoR 分 配 接触 符号 ， 可 以 
细 化 上 述 方法 。 对 于 每 一 个 接触 法 向 ， 对 于 固定 
的 接触 法 向 在 接触 点 处 标记 CoR 为 f， 对 于 滑动 接 
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触 在 法 向 线 上 的 其 他 CoR 标记 为 s， 对 于 分 离 接触 
其 他 所 有 的 CoR 则 标记 为 bp。 这 一 系列 标记 给 出 了 
一 种 特定 零件 运动 的 接触 模式 。 在 平面 情况 下 ， 
接触 法 向 上 标记 为 s 的 可 以 进一步 细 化 为 s, 或 s， 
其 可 以 指明 零件 相对 约束 是 在 其 左 侧 还 是 右 侧 滑 
动 。 对 于 在 接触 上 方 标记 为 +( 沿 着 接触 法 向 方 
向 ) 或 者 在 接触 下 方 标记 - 的 s 型 旋转 中 心 ， 其 
应 该 重新 标记 为 s,， 对 于 在 接触 上 方 标 记 为 -或 
在 接触 下 方 标记 + 的 s 型 旋转 中 心 应 标记 为 s， 如 
图 27.2d 所 示 。 

这 种 方法 可 以 轻易 地 判断 零件 是 否 处 于 形 闭 环 。 
如 果 不 存 在 标志 一 致 的 旋转 中 心 ， 则 可 行 的 速度 锥 面 
只 包括 零 速 度 点 ， 并 且 零 件 被 静止 约束 固定 。 该 方法 
也 说 明 : 对 于 一 阶 分 析 至 少 需要 4 个 约束 条 件 来 固定 
零件 (参见 第 28 章 ) 。 这 是 一 阶 分 析 的 缺陷 : 曲率 
效应 可 以 用 3 个 或 甚至 2 AYR WIESE ROT, 
该 缺陷 在 图 27. 2d 中 也 有 体现 ， 被 标记 为 |+, s,bs, | 
的 旋转 中 心 的 纯 旋 转 事实 上 是 不 可 行 的 ， 如 果 零 件 在 
与 机 械 手 指 接触 的 位 置 具有 较 小 的 曲率 半径 ， 则 
该 情况 就 是 可 行 的 。 一 阶 分 析 忽略 了 这 样 的 曲率 
要 求 。 


27.3 ” 力 和 摩擦 力 


机 器 人 操作 中 一 种 常用 的 摩擦 力 模 型 是 库仑 定 
律 ””1。 该 实验 规律 表明 摩擦 力 在 接触 面 处 的 切 平 
面 内 幅 值 与 法 向 力 / 的 幅 值 有 关 ， 两 者 关系 为 : 
fÁsuf,, FOP u 为 摩擦 系数 。 如 果 为 滑动 接触 ， 则 
/=kf,， 且 摩擦 力 方向 与 运动 方向 相反 。 摩 擦 力 与 滑 
动 速度 无 关 。 

经 常 定义 两 个 摩擦 力 系数 静摩擦 系数 从 和 动 
(滑动 ) PRAM u, IPF u, > 心 的 关系 。 这 意味 
着 更 大 的 摩擦 力 可 以 用 来 阻止 内 部 运动 ,但 是 一 旦 开 
台 运 动 ， 阻 力 就 减 小 。 许 多 其 他 的 摩擦 模型 已 经 发 展 
为 具有 诸如 滑动 速度 及 滑动 前 静态 接触 的 持续 时 间 等 
不 同 功 能 依赖 性 因素 的 模型 ， 所 有 这 些 都 是 复杂 微观 
行为 的 集合 模型 。 为 简单 起 见 ， 假 设 最 简单 的 库仑 摩 
擦 力 模型 只 有 单一 的 摩擦 力 系数 内 ， 该 模型 适用 于 坚 
硬 的 干 物质 。 摩 擦 力 系 数 取决 两 接触 物体 的 材料 ， 基 
本 上 在 0.1 至 1 的 区 间 变 化 。 

图 27. 3a 表明 摩擦 定律 可 以 用 摩擦 锥 解释 。 由 支 
撑 线 施加 给 圆 盘 的 所 有 力 的 集合 被 限制 在 该 锥 体内 。 
相应 的 ， 圆 盘 施 加 给 支撑 面 的 任何 作用 力 是 在 锥 体 负 
半 轴 的 内 部 。 椎 体 的 半角 B = tanu, WE 27.4 所 
示 。 如 果 圆 盘 在 支撑 面 上 向 左 侧 滑 动 ， 支 撑 施 加 给 圆 
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图 27.3 a) 平 面 摩擦 锥 b) 与 之 对 应 的 扭矩 锥 面 
c) 两 个 摩 氛 接 触 下 的 合成 扭矩 锥 面 的 实例 


如 果 选 择 一 个 坐标 系 ， 由 支撑 面 施加 给 圆 盘 的 力 
f WR AH w=[(xx f)", fT)’, 其 中 x RAE 
LAL, AREER HER RAHE, WE 27. 3b 所 
示 。 平 面 摩擦 锥 的 两 条 边界 线 在 扭矩 空间 中 提供 了 两 
条 半 直 线 ， 通 过 接触 传递 给 零件 的 扭矩 都 是 沿边 界 的 
基本 向 量 的 非 负 线性 组 合 。 如 果 w 和 w: 是 扭矩 锥 这 
些 边界 上 的 基本 向 量 ， 可 以 把 扭矩 锥 表示 为 : WC = 
[kiwi +k,w, |k,, k 20}. 

如 果 物 体 上 有 多 个 接触 面 ， 那 么 由 接触 传递 给 物 
体 的 所 有 捏 矩 的 集合 是 所 有 独立 扭矩 锥 WC, WIERE 
组 合 。 


WC =pos( | WC,}) = | 5 kw, | w, e WC, ,k, 20} 


这 个 合成 扭矩 锥 是 根 在 原点 的 凸 多 面体 锥 体 。 一 
个 由 两 个 平面 摩擦 接触 产生 的 合成 扭矩 锥 的 实例 
如 图 27.3c 所 示 。 如 果 合 成 扭矩 锥 上 就 是 整个 扭 
和 矩 空间 ， 则 接触 可 以 提供 一 个 力 闭 合 抓 取 (第 28 
章 )。 在 空间 情况 下 ， 当 接触 法 向 沿 z 向 的 正 问 时 
( 见 图 27.4)， 摩 擦 锥 是 一 个 由 式 (27.9) 定义 的 
圆锥 。 


V fit fip f. f mo (27.9) 
其 余 的 扭矩 锥 和 多 接触 情况 的 合成 扭矩 锥 pos 
CWC) 是 一 个 根 在 原点 ， 而 非 多 面体 的 凸 锥 体 。 
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为 了 计算 的 目的 ， 通常 把 圆 形 摩擦 锥 近似 为 楼 锥 ， 如 
图 27.4 所 示 。 单 独 的 与 合成 的 扭矩 锥 在 六 维 扭矩 空 
间 里 转变 成 凸 多 面体 锥 体 。 


图 27.4 a) 空 间 摩擦 锥 , 锥 体 半 
锥 的 内 接 锥 体 的 近似 ,通过 增加 锥 体 的 面 数 以 获得 更 精 


B-ian^'u b) 摩擦 


确 的 内 接 锥 体 逼 近 。 根 据 应 用 情况 ,可 以 采用 外 切 棱 猴 
来 代替 内 接 棱 猴 


如 果 作 用 在 零件 上 的 单个 接触 或 接触 的 集合 是 由 
理想 力 控制 的 ， 则 由 控制 器 规定 的 扭矩 ws 必须 位 于 
与 这 些 接触 相对 应 的 合成 扭矩 锥 内 。 由 于 这 些 力 控制 
型 的 接触 选择 了 这 个 扭矩 锥 的 一 个 子 集 (TREES 
一 扭矩 ) ， 能 够 作用 在 物体 上 的 合成 扭矩 锥 的 集合 
(包括 其 他 的 非 力 控制 的 接触 ) 可 能 不 再 是 根 位 于 原 
点 的 齐 次 锥 体 。 这 种 情况 大 致 类 似 于 27.2.1 节 讲 述 
的 速度 控制 型 接触 ， 它 会 导致 零件 可 行 的 旋 量 集合 不 
再 是 根 在 原点 的 锥 体 。 理 想 的 机 器 人 操作 可 能 由 位 置 
控制 、 力 控制 、 位 置 一 力 混合 控制 或 其 他 方法 控制 ， 
控制 方法 必须 与 零件 之 间 的 接触 类 型 和 环境 相 兼容 ， 
以 防止 过 多 的 作用 力 |。 


27.3.1 平面 图 解法 


正如 平面 问题 的 齐 次 旋 量 锥 能 够 用 在 该 平面 内 标 
记 有 (“+” 或 “-”) CoR 的 凸 面 区 域 表 示 ， 平 面 
问题 的 齐 次 扭矩 锥 可 以 在 平面 内 用 标记 的 凹面 区 域 表 
示 ， 这 被 称 为 力矩 标记 法 ”1 。 在 平面 内 给 定 作 
用 力 的 作用 线 的 集合 〈 例 如 ,， 来自 点 接触 集合 的 摩 
擦 锥 的 边界 ) ， 所 有 这 些 非 负 线性 组 合 的 集合 可 以 用 
平面 内 所 有 的 点 表示 ， 如 果 这 些 点 产生 关于 该 点 非 负 
的 力矩 则 标记 为 “+”， 如 果 关 于 该 点 产生 非 正 的 力 
和 矩 则 标记 为 “-”， 如 果 关于 该 点 是 零 力矩 则 标记 为 
“ 土 ” ， 如 果 关 于 该 点 既 可 以 产生 正 值 力矩 也 可 以 产 
生 负 值 力矩 ， 则 该 点 为 空白 标记 。 

上 述 观 点 最 好 用 实例 说 明 。 在 图 27. 5a 中 ,通过 
标记 线 左 侧 的 点 为 “+”， 线 右 侧 的 点 为 “- ”的 方 


法 表示 单 根 力 的 作用 线 。 位 于 线 上 的 点 标记 为 
"€", 在 图 27.5b 中 ， 增 加 了 另外 一 条 力 的 作用 线 ， 
平面 内 只 有 那些 被 两 条 力作 用 线 兼容 的 点 保留 着 它们 
的 标记 ， 不 能 被 兼容 标记 的 点 不 再 采用 原 有 标记 。 最 
后 ， 在 图 27. 5c 中 增加 了 第 三 条 力 的 作用 线 ， 其 结果 
是 只 有 单独 的 一 块 区 域 被 标记 为 “+”， 三 条 力作 用 
线 的 非 负 组 合 在 平面 内 可 以 生成 任何 以 逆 时 针 方向 穿 
过 该 区 域 的 力 的 作用 线 。 这 种 表达 方式 等 价 于 扭矩 的 
齐 次 凸 锥 面 的 表达 方式 。 
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图 27.5 a) 和 采用 力矩 标识 表示 力 的 作用 线 b) 采 用 力 


和 抢 标 识 表示 两 条 力作 用 线 的 非 负 线性 组 合 0) 三 条 力 
作用 线 的 非 负 线 性 组 合 


27.3.2 ”接触 扭矩 和 扭转 自由 度 的 对 偶 性 


关于 运动 学 约束 和 摩擦 力 的 讨论 应 该 清楚 地 认识 
到 : 对 于 任何 的 点 接触 及 其 接触 标记 ， 由 接触 导致 的 
物体 运动 的 等 式 约束 条 件 的 数目 ， 与 其 提供 的 扭转 自 
由 度 的 数目 相等 。 例 如 ， 分 离 接触 b 对 于 零件 的 运动 
没有 提供 等 式 约束 条 件 ， 并 容许 没有 接触 力 。 固 定 接 
触 了 提供 了 三 个 运动 约束 (零件 上 点 的 运动 是 特定 
的 ) 和 三 个 接触 力 的 自由 度 : 任何 处 于 接触 扭矩 锥 
内 的 扭矩 与 接触 模式 保持 一 致 。 最 后 ， 滑 动 接 触 s 提 
供 了 一 个 等 式 约束 条 件 (为 了 保持 接触 零件 运动 必 
须 满 足 的 等 式 ) ， 对 于 给 定 的 满足 约束 的 运动 ， 接 触 
扭矩 只 有 1 个 自由 度 ， 在 摩擦 锥 边界 上 的 接触 扭矩 的 
幅 值 是 唯一 的 ， 并 且 与 滑动 方向 反 向 。 在 平面 情况 
下 ， 对 于 b、s 和 f 三 种 接触 的 运动 约束 和 扭矩 自由 
度 分 别 为 0，1，2。 

在 每 个 接触 位 置 ， 在 接触 面 上 的 力 和 速度 约束 
可 以 用 n x6 MARERE H RRR, 
约束 和 矩阵 就 像 过 滤器 一 样 传递 或 拒绝 穿越 接触 平面 
的 运动 因素 。 同 样 的 道理 ， 施 加 到 整个 接触 平面 的 
力 或 力矩 被 同一 个 约束 和 矩阵 下 "以 对 偶 的 关系 过 滤 选 
择 。 接 下 来 将 介绍 三 种 典型 的 接触 模型 。 在 机 架 接 
触 处 的 接触 法 向 为 z 轴 正 向 的 接触 力 和 扭矩 会 被 


测量 。 
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1) 无 摩擦 的 点 接触 模型 。 在 接触 物体 间 只 有 法 
向 力 大 是 外 力 。 
f.20,w=H'f.=(001000)'f, (27.10) 
2) A REIRI x Be SCR ER. FU EI JI fo, SE 
HEDI I8] EET 7] f RI S, o 


EZG |f |= Vf fuf 
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ART 
w-H /| dn ^ (27.11) 
£A Jo o o| M^ 
000 
式 中 ,是 x 向 切 向 接触 力 ; 上 是 y 向 切 向 接触 力 ; 


人 是 法 向 力 。 

3) 具有 有 限 接触 域 的 软 指 接 触 模型 除 具 有 摩擦 
力 和 法 向 力 外 ,还 允许 有 相对 接触 法 向 的 扭转 
Fy ffi imos» 


f20 
100 0 
Fe) 10 10 Ol fs 
JAJI looi ojl 6 
w=H = "| (27.12) 
X looo ol £ 
mJ |0 0 0 0f\n, 
0001 


AP, mE AE T ANA SJE H E ER E fik Td 
假定 的 有 限 接触 域 除了 会 产生 牵引 力 外 ， 还 会 产生 摩 
擦 力矩 。 如 果 接 触 处 切 平面 内 的 合力 可 以 表示 为 = 


Sho + ff， 且 相 对 于 接触 法 向 的 力矩 为 m,， 如 下 的 
椭圆 方程 表示 了 滑动 起 始 处 力 和 力矩 的 关系 : 
f m? 
A | 


2 2 
a b 


SUP, a = uf KOER; 5 = (m) EÑ 
(27.32) 定义 的 最 大 力矩 。 关 于 这 个 问题 的 更 多 的 
文章 参见 参考 文献 [27. 35-42]. 

从 以 上 三 种 情况 可 以 得 出 : RE H 的 行 代表 所 
提供 接触 力 的 沿 着 的 方向 。 相 反 地 ， 两 物体 的 相对 运 
动 方向 也 由 这 些 方向 限制 : Hg =0。 所 以 ， ARE 
阵 就 像 一 个 动态 过 滤器 一 样 限 制 了 那些 可 以 传递 整个 
接触 面 的 运动 因素 。 约 束 和 矩阵 的 引入 使 得 建立 的 接触 
力学 模型 分 析 更 加 简单 ， 该 分 析 采 用 力 / 力 矩 与 运动 
间 动 态 对 偶 关 系 的 方法 ， 见 表 27.2。 例 如 ， 式 
(27.12) 中 的 约束 选择 矩阵 揭示 了 这 样 的 现象 : 力 
的 三 要 素 和 关于 接触 法 向 的 力矩 的 其 中 一 个 参数 可 以 
被 传递 到 软 指 的 接触 面 。 

在 第 28 章 ， 当 考虑 多 接触 情况 时 ， 诸 如 与 每 个 
手指 有 关 的 豆 和 矩阵 可 以 级 联 到 一 个 增 广 和 矩阵， 联合 
抓 取 和 雅克 比 矩 阵 ， 用 来 进行 抓 取 动 作 和 操作 的 
分 析 。 

表 27. 2 总 结 了 力 / 力 和 矩 和 位 移 的 对 偶 关 系 ， 即 从 
虚拟 任务 中 推导 出 来 的 结论 。 在 表 27. 2 vh, J, FEM 
系 关 节 速 度 和 指 尖 速 度 的 雅克 比 矩 阵 ， 几 是 联系 接触 
点 和 抓 取 物 体 的 重力 坐标 系 的 笛 卡 儿 坐 标 系 转换 矩 
阵 。 此 外 ， 在 作业 空间 内 的 运动 自由 度 的 数目 为 n， 
关节 空间 内 的 自由 度数 目 为 m。 


(27.13) 


A 27.2 接触 面 的 动态 对 偶 性 


关节 接触 物体 
FIM Jj x 60 = Ox; H x 6x, = Ox, =H x Ox, — J, x Ox, = ôx, 
运动 
(6xm) (mx1) (6x1) (nx6) (6x1) (nxl) (nx6) (6x1) (6x6) (6x1) (6x1) 
六 Io x fp = T — fi H xf = hoI x fh = 态 
(mx6) (6x1) (mx1) (6x1) (6xn) (nxl) (6x1) (6x6) (6x1) (6x1) 


对 于 手指 和 被 抓 取 的 物体 ， 其 在 各 自 的 关节 空 
间 、 接 触 表 面 和 物体 的 笛 卡 儿 坐 标 系 内 的 力 与 力矩 的 
关系 具有 对 偶 性 。 表 27. 2 P, 0, x, x,, x, AE 
示 关 节 空 间 的 位 移 ， 在 手指 接触 点 处 笛 卡 儿 坐标 系 内 
的 位 移 ， 在 物体 的 接触 点 处 的 笛 卡 儿 坐 标 系 内 的 位 
移 ， 在 物体 参考 坐标 系 内 的 位 移 ，x, 表 示 传 递 因素 。 
前 级 6 表示 在 各 命名 坐标 系 下 的 微小 变化 。 各 作用 力 
的 相应 下 标 可 以 参考 对 应 坐标 系 下 如 上 文 所 描述 的 各 


位 移 的 标记 方式 。 
27.4 考虑 摩擦 时 的 刚体 力学 


操作 规划 问题 就 是 选择 机 械 手 接触 面 施加 的 运动 
和 力 ， 以 便 单 一 零件 (或 多 个 零件 ) 按 预期 目的 运 
动 。 这 要 求解 决 在 给 定 特定 的 机 械 臂 行为 的 情况 下 确 
定 各 零件 的 运动 的 子 问题 。 
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设 ysR "属于 局 部 坐标 系 ， 该 坐标 系 表示 由 一 
个 或 更 多 个 零件 和 机 械 手 组 成 的 系统 的 组 合 外 形 ， 并 
Wt w, e R “表示 在 正 接触 ;处 的 扭矩 ， 该 扭矩 在 通用 
坐标 系 0 内 被 测量 。 设 wi e R“ 为 通过 累计 mw, 获得 
HAE, wa = (wi wm w, ) (RA kA BERI), 
设 A(g) e R"*” 表 示 接 触 扭 矩 是 如 何 (或 是 否 ) 作 
用 在 每 个 零件 上 的 矩阵 。( 请 注意 ， 作 用 在 一 个 零件 
上 的 接触 扭矩 w, 意 味 着 存在 一 个 接触 扭矩 - w; 作 用 
在 接触 的 另 一 物体 上 。) 问题 在 于 确定 接触 力 wu 和 
系统 的 加 速度 gq ， 给 定 系统 (94，4 ) 状态 和 系统 质 
量 矩 阵 M(g) ， 可 以 求 得 科 氏 抢 阵 C(g，g ) ， 重 力 
gs(g) ， 约 束 力 z 以 及 描述 约束 力 z 是 如 何 作 用 在 系统 
EWERT) (另外 ， 如 果 把 机 械 手 视 为 位 置 控 
制 ， 机 械 手 加 速度 9 的 各 因素 和 求解 得 到 的 与 之 相 
对 应 的 约束 力 T 的 各 因素 可 以 直接 规定 。) 解决 该 问 
题 的 一 种 方法 是 : 1) 列举 当前 正 接触 接触 模型 的 所 
有 可 能 的 集合 ; 2) 对 于 每 种 接触 模型 ， 确 定 是 否 存 
在 扭矩 wu 和 加 速度 9 满足 动力 学 方程 (27.14), 
以 及 判断 其 是 否 与 接触 模型 的 运动 学 约束 (关于 加 
速度 q 的 约束 ) 和 摩擦 锥 的 力学 约束 (关于 接触 力 
wa 的 约束 ) 。 

A(q)wa *T(q)t-g(q) -M(q) q *C(q,q)4 

(21.14) 
该 方程 很 常见 ， 并 可 以 应 用 到 多 零件 接触 的 情况 中 。 
方程 式 (27. 14) 可 以 通过 恰当 的 表达 刚体 零件 的 外 
形 和 速度 的 方法 得 到 简化 (例如 ， 用 刚体 的 角速度 
代替 局 部 角 坐 标的 导数 ) 。 

该 方程 引出 了 一 些 令 人 惊讶 的 结论 : 对 于 特定 
的 问题 可 能 存在 多 解 (多 义 性 ) 或 者 无 解 (不 一 致 
性 ) OTT) 。 这 种 奇怪 的 现象 是 在 库仑 定律 是 一 种 近 
似 法 则 ， 并 忽略 摩擦 或 摩擦 力 足 够 小 的 情况 下 产生 
的 。 尽 管 这 是 库仑 摩擦 定律 的 缺陷 ,但 这 是 有 效 地 
近似 。 虽 然 如 此 ， 如 果 想 证 实物 体 一 种 特定 预期 的 
运动 发 生 了 ， 通 常 也 必须 证 实 不 会 发 生 其 他 的 运动 。 
否则 ， 我 们 仅仅 说 明了 预期 运动 只 是 一 种 可 能 的 


d 
结 o 


27.4.1 互补 性 


每 种 接触 提供 相同 数目 运动 约束 和 扭矩 自由 度 的 
情况 (27.3.2 节 ) 可 以 记 作 互 补 性 条 件 。 因 此 求解 
方程 式 (27.14) 受 接触 约束 限制 的 问题 可 以 归结 为 
互补 性 问题 ( CP) ”61 对 于 平面 问题 或 具有 
近似 摩擦 锥 空间 的 问题 ， 其 是 一 种 线性 互补 性 问 


题 “*1。 对 于 圆 形 空间 摩擦 锥 问题 ， 由 于 描述 了 摩 
擦 锥 的 二 次 约束 ， 其 是 一 种 非 线 性 互补 性 问题 。 在 这 
两 种 情况 下 ， 可 以 采用 标准 算法 来 解决 可 能 的 接触 模 
型 和 零件 运动 。 

男 外 ,假设 为 线性 摩擦 锥 ， 对 于 每 种 接触 模型 可 
以 制定 一 个 线性 约束 满意 度 规划 (LCSP) (例如 ,一 
个 没有 目标 函数 的 线性 规划 ) 。 接 触 模型 展示 了 关于 
零件 加 速度 的 线性 约束 ， 以 及 求解 零件 加 速度 和 用 于 
乘 以 摩擦 锥 每 条 边界 的 非 负 参数 的 受 运动 方程 " 
约束 的 解决 方法 。 每 个 LCSP 方程 的 可 行 解 代表 了 一 
个 可 行 的 接触 模式 。 


27.4.2 ” 准 静 态 假 设 


机 器 人 操作 规划 中 普遍 存在 的 一 个 假设 就 是 准 静 
态 假设 。 该 假设 表明 : 当 零 件 运动 得 足够 慢 时 可 以 忽 
略 惯性 力 的 影响 。 这 意味 着 式 (27.14) 的 左 侧 和 右 
侧 均 为 零 。 通 常 利用 该 假设 求解 物体 的 速度 而 不 是 加 
速度 。 这 些 速度 必须 与 运动 约束 和 力 约束 保持 一 致 ， 
并 且 作用 在 物体 上 的 力 的 总 和 为 零 。 


27.4.3 示例 


虽然 考虑 摩擦 的 刚体 的 力学 问题 通常 采用 处 理 互 
补 性 问题 和 线性 约束 满意 度 规 划 的 计算 手段 来 求解 ， 
等 价 的 图 形 方 法 可 以 用 来 求解 一 些 平面 问题 以 帮助 直 
觉 分 析 。 考 虑 如 图 27.6 所 示 的 管 卡 这 样 一 个 简单 的 
FO, CESARE we 的 作用 下 ， 请 问 管 夹 是 沿 管 
子 滑 下 还 是 保持 原 地 不 动 呢 ? 图 中 的 力矩 用 来 标记 接 
触 力 的 合成 扭矩 锥 ， 接 触 力 则 是 管道 施加 给 管 夹 的 作 
HJ. HEEK EHIE ws 恰好 可 以 与 合成 扭矩 
锥 内 的 扭矩 平衡 。 事 实 显而易见 地 说 明 : 与 ws 相反 
的 力矩 以 顺 时 针 方向 穿 过 标记 有 “+ ”的 区 域 ， 这 
意味 着 该 力矩 处 于 接触 扭矩 锥 内 。 所 以 ， 对 于 管 夹 类 
问题 静态 平衡 ( 企 接 触 模型 ， 是 可 行 的 解决 方法 。 采 


图 27.6 表示 管道 施加 给 管 夹 的 接触 力 的 合成 


扭矩 锥 的 力矩 标记 法 (图 中 ,施加 到 管 夹 上 的 扭 
AB. wes 可 以 被 处 于 合成 摩擦 锥 内 力 抵消 ) 
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用 LCSP 方法 可 以 获得 相同 的 结果 ， 标 记 摩擦 锥 边界 
上 的 单位 扭矩 为 wW ，…，ws。 如 果 存 在 系数 a, ，…， 
a JFE a, a), az, a, 20, aw, +a,w, + aW, +a, 
ws tw, =0， 那 么 管 夹 将 保持 不 动 。 

必须 排除 其 他 接触 模型 的 情况 以 说 明 静 平衡 状态 
是 唯一 的 解 。 请 注意 ， 如 果 各 接触 面 的 摩擦 系数 太 
小 ， 那 么 管 夹 力 将 减少 为 ws 

经 典 的 孔 中 销 钉 问题 的 分 析 和 管 夹 问 题 是 相 
Whi, Al 27. 7a 描述 了 一 个 与 孔 有 两 个 接触 点 的 
倾斜 销 钉 。 如 果 施 加 两 点 接触 不 能 抵消 扭矩 w， 
则 在 型 的 接触 模式 是 不 可 能 的 ， 且 销 钉 会 继续 插 
进 孔 中 。 如 果 施 加 接触 能 够 抵消 扭矩 w,， 这 样 销 
钉 就 会 被 卡 住 ， 这 被 称 为 棉 紧 ”i 。 如 果 接 触 处 
存在 更 大 的 摩擦 力 ， 如 图 27.7b 所 示 ， 然 后 每 一 
个 摩擦 锥 能 够 看 见 其 他 的 基础 ， 并 且 可 行 的 接触 
扭矩 穿越 整个 扭矩 空间 ””"”。 在 这 种 情况 下 ， 施 
加 的 任何 扭矩 都 可 以 被 接触 抵消 ， 销 钉 被 称 为 枫 
OTST 。 事 实 上 销 钉 是 否 会 抵消 施加 的 扭矩 取决 
于 接触 间作 用 了 多 大 的 内 力 ， 这 个 问题 不 能 用 刚 
体 模 型 解释 ， 其 要 求 柔 性 接触 模型 才能 解释 ， 将 
会 在 27. 6 节 中 讨论 该 模型 。 


b) 
图 27.7 a) 销 钉 在 外 扭矩 w 的 作用 下 会 插入 孔 中 ， 
但 是 又 会 被 扭矩 w KE b) FET OBL 


考虑 桌面 上 一 个 正在 被 机 械 手指 水 平 向 右 推 动 的 
物体 的 情况 ， 作 为 一 个 稍微 复杂 的 准 静 态 的 例子 
( 见 图 27.8)'”” 1。 零件 是 倾倒 还 是 滑动 ， 还 是 滑 
动 和 倾倒 同时 发 生 呢 ?与 其 对 应 的 接触 模型 为 fbs,， 
sis1f，sibs,， 如 图 27.8 所 示 。 该 图 同时 也 展示 了 使 
用 力矩 标记 的 合成 接触 招 矩 锥 。 很 显然 , 重力 和 接触 
招 和 矩 锥 的 准 静 态 平 衡 只 适用 于 没有 滑动 的 倾倒 接触 模 
式 fbs,。 因 此 ， 的 准 静 态 解 是 物体 开始 无 滑动 倾 
和 斜 ， 且 手指 运动 速度 决定 该 运动 速度 的 时 候 。 图 形 化 
的 方法 可 以 用 来 肯定 我 们 的 直觉 来 判断 物体 的 倾倒 是 
发 生 在 对 物体 的 推动 力 大 或 者 是 物体 支撑 的 摩擦 系数 
大 的 时 候 。 可 以 通过 推 一 个 炙 头 或 玻璃 杯 尝 试 一 下 。 


准 静 态 下 ， 质 量 中 心 的 高 度 是 无 关 紧要 的 。 


系数 为 人 的 物体 由 水 平方 向 上 周期 性 运动 
撑 。 周 期 性 运动 由 一 个 大 
和 小 


上 


图 27.8 a) 在 重力 场 中 , 置 于 桌面 上 的 手指 向 左 移动 到 
一 个 平面 区 域 ,并 引入 接触 摩擦 锥 b) 对 于 在 底部 最 左 
侧 为 f 型 的 接触 ,底部 最 右 侧 为 b 型 接触 及 标记 为 的 
推 接触 的 接触 情况 下 可 能 产生 的 接触 力 。 这 种 fbr 型 接 
触 模式 对 应 于 在 接触 最 左 侧 的 倾倒 。 请 注意 ,接触 扭矩 
oft CHAR ) 可 以 提供 恰好 平衡 重力 的 作用 力 。 因 
此 这 种 接触 模式 极为 可 能 发 生 c) XEF ur 接触 模式 
(物体 在 桌面 上 向 左 滑 动 ) 的 接触 扭矩 锥 不 能 平衡 重 
力 。 这 种 接触 模式 极为 不 可 能 发 生 d) XEF Ibr 接触 模 
式 ( 物 体 滑 动 和 倾倒 同时 发 生 ) 是 极 不 可 能 发 生 的 


最 后 一 个 示例 如 图 27. 9 所 示 。 质 量 为 m HEX 
的 水 平面 支 
时 间 短 的 负 值 加 速度 运动 
时 间 长 的 正 值 加 速度 运动 组 成 。 施 加 到 零件 上 
4 水 平 摩擦 力 由 上 Hmg 限定 ， 所 以 零件 的 水 平 加 速度 


H 


H zug 限定 。 所 以 ， 零 件 不 可 能 跟 上 表面 运动 ， 因 


E 


i 
aa ‘eal | 


图 27.9 a) 被 水 平 振动 平面 支撑 的 物体 b) 物 体 和 文 
撑 面 间 的 摩擦 力 使 零件 总 是 追赶 支撑 面 ,但 是 其 运动 
加 速度 被 ug 限制 。 支 撑 面 的 不 对 称 运动 使 零件 在 一 
个 运动 周期 内 获得 了 平均 正 值 速度 
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为 其 加 速度 滞后 。 相 反 ， 和 零件 相对 表面 向 前 滑动 ， 这 
意味 着 最 大 摩擦 力 表现 为 负 值 方 向 ， 并 且 和 零件 试图 降 
低 表面 的 速度 。 最 终 零 件 以 缓慢 的 向 前 加 速度 赶 上 了 
表面 运动 ， 该 加 速度 小 于 yg。 零件 一 旦 追赶 上 表面 
运动 ， 零件 就 寿 附 于 表面 上 运动 ,一 直到 下 一 个 向 后 
加 速度 时 期 。 从 图 27.9 可 以 明显 看 出 ,零件 一 周 内 
的 平均 速度 为 正 值 ， 所 以 零件 在 支撑 面 上 向 前 运 
Bye?) 。 这 种 想法 可 以 扩展 到 在 刚性 圆 盘 上 建立 
一 个 多 种 类 的 摩擦 力 场 ， 该 刚性 圆 盘 在 水 平面 内 有 3 
个 自由 度 的 振动 ”5 或 者 具有 6 个 自由 度 。 
采用 考虑 库仑 摩擦 的 刚体 模型 的 操作 规划 的 进一步 
示例 ， 请 参见 参考 文献 [27.14] 和 所 附 的 参考 文献 。 


27.5 EERIE 


摩擦 力 约束 的 表面 (27.7 节 ) 对 于 分 析 推 操作 
是 有 用 的 ， 它 描述 了 物体 在 支撑 面 上 滑动 时 产生 的 
摩擦 力 。 当 物体 由 包含 在 极限 曲面 内 的 扭矩 推动 时 ， 
物体 和 支撑 间 的 摩擦 力 抵消 推力 并 保持 物体 不 动 。 
当 物 体 准 静态 滑动 时 ， 推 力 w 位 于 极限 曲面 上 ， 且 
物体 的 旋 量 上 垂直 于 在 w 处 的 极限 曲面 ( 见 图 
27.10) 。 当 物体 无 旋转 的 平移 时 ， 摩 擦 力 的 幅 值 为 
umg, P m 为 物体 质量 ，g 为 重力 加 速度 。 由 物 
体 施加 给 表面 的 作用 力 在 平移 方向 直接 通过 物体 的 
质心 。 


图 27.10 a) 推 力 器 和 滑动 物体 间 的 接触 上) 合成 接触 


THIEME “) 在 限定 曲面 中 将 扭矩 锥 映射 到 物体 的 旋 量 锥 
d) 在 合成 扭矩 锥 中 可 以 产生 作用 力 的 单位 旋 量 


如 果 推 力矩 产生 关于 零件 质心 的 正 值 力矩 ， 零 


件 会 逆 时 针 旋 转 (CCW), ， 如 果 产 生 关于 零件 质心 
的 负 值 力矩 ， 零 件 会 顺 时 针 旋 转 (CCW). TARE, w 
果 零 件 上 的 接触 点 以 CW (或 COW) 方向 沿 着 穿 过 
零件 质心 做 直线 运动 ， 则 零件 会 顺 时 针 旋 转 ME 
针 旋 转 )。 从 这 两 个 观察 并 考虑 所 有 可 能 的 接触 模 
式 可 以 得 出 结论 : 由 点 接触 推动 的 零件 在 满足 条 件 
QO 或 @@ 中 的 一 个 时 ， 会 产生 CW 方向 旋转 (CCW). 
接触 摩擦 锥 的 两 条 边 都 顺 时 针 ( 逆 时 针 ) 方向 穿 
过 质心 ; @ 摩 擦 锥 的 一 条 边 和 接触 点 的 推动 方向 都 
以 顺 时 针 (BRET ET) De ra Bb T, CI 
27. 11) 。 


摩擦 锥 


| ' E 


Æ 27.11 DRA 75 A T 26 ETE BAI RESET 7 A, 
但 是 更 倾向 于 摩擦 锥 均 以 顺 时 针 方 向 旋转 的 两 条 边界 的 方向 


该 观测 容许 用 推 操作 来 减少 零件 方向 的 不 确定 
性 。 一 系列 具有 平 栅 的 推 操作 可 以 彻底 排除 多 边 形 零 
件 在 定向 上 的 不 确定 性 ”3。 零 件 旋 转速 率 上 的 
约束 准许 一 系列 悬浮 在 传送 带 上 空 的 固定 围栏 的 使 
用 ， 该 传送 带 通 过 推动 零件 就 像 被 传送 带 运 载 一 样 的 
方式 来 定向 零件 1。 平稳 的 推进 规划 ( 见 图 
27.12) 采用 这 样 推动 运动 方案 : 当 零 件 移动 时 ， 其 


图 27. 12 平稳 的 推动 可 以 用 来 操作 零件 在 障碍 中 运动 
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保证 零件 固定 在 推力 器 上 ， 甚 至 是 零件 压力 分 布 不 确 
定 的 表面 上 后 4 。 对 于 零件 的 平面 组 件 可 以 扩展 
推动 运动 的 应 用 ， 所 以 在 运动 过 程 中 零件 都 固定 于 它 
ATT EG HEL eh HOT 

以 上 示例 假设 推力 和 支撑 摩擦 力作 用 在 同一 个 平 
面 内 。 其 他 有 关 推 操作 的 任务 已 经 考虑 了 施加 到 支撑 
平面 上 的 推力 的 三 维 空间 影响 ”|。 


27.6 ”接触 面 及 其 建 模 


接触 面 是 一 种 用 来 描述 运动 学 和 动力 学 接触 
的 普遍 表达 形式 。 各 种 内 容 的 接触 被 应 用 到 机 絮 
人 研究 中 。 因 此 ， 参 照 无 限制 手指 抓 取 和 操作 的 
一 般 性 的 接触 作为 接触 面 会 更 有 意义 。 接 触 面 的 
概念 可 以 延伸 到 传统 的 物理 接触 的 内 容 上 。 它 涉 
及 继承 动态 滤波 和 在 接触 面 内 传递 力 / 运 动 的 对 偶 
性 的 接触 面 。 

所 以 ， 无 论 一 个 接触 面 是 刚性 的 还 是 可 变形 的 ， 
它 都 可 以 看 做 具有 两 个 特征 的 动态 过 滤器 : 中 传递 运 
动 和 力 ; @ 并 且 在 力 /力矩 和 运动 间 存 在 对 偶 性 。 接 
下 来 的 章节 将 会 描述 不 同 的 接触 面 。 

本 章 之 前 的 章节 已 经 假定 了 接触 中 的 刚体 。 
然而 ， 实 际 上 所 有 的 接触 都 伴随 着 物体 的 一 定 程 
度 的 变形 。 常 常 通过 设计 使 其 处 于 机 器 人 和 柔性 指 
尖 的 情况 下 。 当 变形 不 可 忽视 时 ， 可 以 使 用 弹性 
接触 模型 。 


27. 6.1 接触 面 建 模 


接触 模型 取决 于 接触 物体 的 性 质 ， 包 括 它们 的 材 
料 特性 ， 被 施加 的 作用 力 ， 接 触 变 形 和 弹性 系数 。 本 
节 将 讨论 不 同 的 接触 模型 。 

1l. 刚体 的 点 接触 模型 

刚体 假设 理论 在 本 章 之 前 的 小 节 中 已 经 讨论 过 ， 
在 该 假设 理论 下 ， 两 种 模型 经 常 被 使 用 : 由 无 摩擦 的 
点 接触 模型 ，@@ 有 摩擦 的 点 接触 模型 。 在 前 一 种 情况 
下 ， 接 触 只 能 施加 垂直 接触 方向 的 力 。 在 后 一 种 情况 
下 ， 除 了 法 向 力 还 可 以 施加 切 向 力 。 最 简单 的 有 摩 探 
点 接触 的 分 析 模 型 就 是 式 (27.9) 描述 的 库仑 摩擦 
模型 。 

2. 赫兹 接触 模型 

弹性 接触 模型 首次 被 研究 并 在 一 个 多 世纪 前 由 
赫兹 于 1882 AE EO) ， 该 模型 基于 两 线性 弹性 
材料 间 的 接触 ， 并 具有 会 导致 很 小 接触 变形 的 法 向 
力 。 它 通常 被 称 作 赫 兹 接触 ， 并 可 以 在 大 部 分 力学 
书籍 中 找到 ， 例 如 参考 文献 [27.71，72]。 为 了 使 


赫兹 接触 模型 有 具有 应 用 性 ， 赫 兹 做 出 了 两 个 重要 的 
明确 假设 : 

1) 接触 的 物体 是 线性 弹性 材料 。 

2) 相对 物体 尺寸 为 小 接触 变形 。 

赫 效 采用 球形 玻璃 透镜 和 平面 玻璃 圆 盘 进行 实验 
来 验证 接触 理论 。 

应 用 到 机 器 人 接触 面 的 赫兹 接触 理论 的 两 项 
相关 成 果 可 以 总 结 如 下 。 第 一 项 成 果 涉 及 接触 区 
域 半径 。 赫 兹 "研究 接触 域 随 基 于 线性 弹性 模 
型 施加 的 法 向 力 N 的 函数 的 变化 而 变化 。 根 据 10 
个 实验 性 试验 ,赫兹 得 出 结论 接触 域 的 半径 与 
增加 到 力 的 1/3 时 的 法 向 力 成 正比 关系 ,该 结论 
与 他 基于 线性 弹性 模型 推导 出 的 分 析 结 果 一 致 。 
接触 域 半 径 a 与 法 向 力 N 有 关 ， 其 关系 如 式 
(27.15) 所 示 。 


acc N* (27. 15) 

第 二 个 结论 涉及 关于 假定 的 接触 域 上 的 压力 分 
布 ， 它 是 一 个 具有 椭圆 或 圆 性 质 的 二 阶 压力 分 布 。 对 
于 一 个 对 称 圆 形 接触 域 ， 其 压力 分 布 为 
od] 


Ta 
式 中 ，N 为 法 向 力 ; a 为 接触 域 半径 ; > 为 到 接触 中 
心 的 距离 ， 且 0<r<a。 
3. 软 接触 模型 
在 软 指 和 接触 面 间 典 型 的 接触 面 如 图 27. 13 所 
示 。 在 典型 的 机 器 人 接触 面 中 ， 指 尖 的 材料 不 是 线性 
弹性 的 。 在 参考 文献 [27. 38] 中 用 包含 赫兹 接触 理 
论 的 震 律 方程 提出 了 从 线性 扩展 到 非 线性 弹性 接触 的 
模型 RODEO 


O 


(27.16) 


a=cN" (27.17) 
HP, y=n/(2n+1) 是 法 向 力 的 震 阶 ,7 为 应 变 强 
化 指数 ; c 为 取决 于 指 尖 大 小 和 曲率 以 及 材料 性 质 的 
常量 。 式 (27.17) 是 一 个 新 的 需 律 方程 ， 其 将 圆 形 
接触 域 半径 的 变化 与 对 软 指 施加 的 法 向 力 联系 起 来 。 
请 注意 ， 该 方程 是 在 假定 为 圆 形 接触 域 的 情况 下 推导 


图 27. 13 与 刚性 面 接触 的 具有 半球 形 指 尖 的 弹性 软 指 尖 
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出 来 的 。 对 于 线性 弹性 材料 ， 常 数 n 等 价 于 y=1/3 ”等 于 法 向 力 ， 即 
中 的 1， 推导 出 式 (27.15) 所 述 的 赫兹 接触 模型 。 [pcd - [^ f p(r)rdrdó = N (27.19) 


所 以 , 式 (27.17) 所 述 的 软 接触 模型 包含 了 赫兹 接 
触 模型 。 将 式 (27. 18) 代入 式 (27.19) 可 以 得 到 参 


4. 其 他 模型 数 Co 值得 注意 的 是 ， 当 式 (27.19) 积分 时 ， 
其 他 模型 包括 仿 人 接触 和 黏 弹性 接触 。 在 和 弹性 。 法 向 力 和 接触 半径 都 消失 了 ， 只 剩 下 常数 C, i 
接触 建 模 过 程 中 ， 除 了 普通 方程 (27.17) W PIN: 


RE 


性 变形 外 ， 蠕 变 和 弛 豫 现 象 都 合并 为 与 时 间 相 关 的 (x) 

x C, = 二 -全 一 (27. 20) 

PRR 9 1 2 
| 


27. 6.2 接触 面 的 压力 分 布 
在 27.6.1 节 中 ， 当 考虑 赫兹 接触 理论 时 ， 对 于 


式 中 ,=1，2，3，… 是 典型 的 整数 (虽然 值 可 能 
RIR); AT O 是 伽 马 函数 省 5 。 参 数 C, 关 


d 


小 弹性 变形 的 假定 压力 分 布 由 式 (27.16) 给 出 。 随 ” 于 一 些 值 的 数值 解 列 于 表 27.3 中 以 做 参考 。 在 图 
着 两 个 凹凸 体 的 曲率 半径 的 增加 以 及 材料 性 质 转变 为 ”27. 14 中 绘制 了 相对 标准 半径 we 的 标准 压力 分 布 图 。 
超 弹性 体 ， 压 力 分 布 变 得 更 加 均匀 ”1 。 归 纳 方 。 从 图 中 可 以 看 出 ,在 C, 21.0 的 情况 下 ， 当 大 值 接近 


程式 (27.16) ， 半 径 为 a 的 圆 形 接触 域 的 压力 分 布 无穷 时 ， 压 力 分 布 会 变 成 幅 值 为 NA( ma ) 的 均匀 分 


x 布 载荷。 
pr) 2a S - (LT) (27.18) 表 27.3 在 压力 分 布 式 (27.18) 中 参数 C 的 值 
Ta a RES ec ae ee, eee eg ae 
式 中 ，N 为 法 向 力 ; a 为 接触 域 半径 ; r 为 半径 且 0< k BRC, 
r&a; 上 决定 压力 剖面 的 形状 ;，C, 为 调节 接触 域 上 压 ERES m 
力 分 布 剖 面 的 参数 ， 以 便 满 足 平衡 条 件 。 在 方程 式 一 一 
(27.18) "P, p(r) 被 定义 在 0<r<a 的 区 域 。 当 kz3 (立方 形 的 ) C, -1.24 
-a<r<0 时 ， 利 对 称 性 可 J 得 p(r ) =p( -r), 如 图 k=4 (四 边 形 的 ) C, =1.1441 
27. 14 所 示 。 当 上 变 大 时 ， 压 力 分 布 接近 均匀 分 布 ， m 
如 图 27. 14 所 示 。 同 时 也 要 求 整个 接触 域 压力 的 积 4 [X MESI 2 =1. 


-1 0 01 02 03 04 05 06 07 08 09 | 


图 27. 14 压力 分 布 相对 于 标准 半径 r/a 的 说 明 (该 图 描述 了 k =2, 3, 4, 5A oc RTH EH 23 
Mak 值 的 增加 ， 压 力 分 布 变 得 更 加 均匀 ) 


对 于 线性 弹性 材料 , 大 值 取 大 =2， 在 某 些 情况 下 

k=1.8 WEA AYO 。 VE e edes 27.7 ”摩擦 限定 面 

材料 , 的 取 值 趋 于 更 大 的 值 ， 这 取决 于 材料 的 

特性 。 27.3 节 介绍 了 扭矩 锥 的 概念 ， 描 述 了 可 以 应 
用 到 有 摩擦 点 接触 模型 的 扭矩 集合 .任何 接 触 所 
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矩 被 约束 在 位 于 锥 体 表面 内 部 的 空间 里 。 这 引入 
— E ee 它 是 包围 扭矩 集合 的 表 
面 ， 该 扭矩 是 通过 给 定 的 接触 或 接触 的 集合 施 
加 的 。 


本 节 将 研究 从 平面 接触 域 中 产生 的 限定 面 的 特殊 
PEDOT 。 当 一 个 平整 的 物体 在 地 面 上 滑动 时 ， 
或 者 柔软 的 机 器 人 手指 按压 多 面体 的 一 个 表面 时 ， 或 
者 仿 人 机 器 人 的 脚 在 地 面 上 拖 动 时 ， 将 产生 平面 接触 
域 。 我 们 想 知道 这 样 的 接触 可 以 传递 什么 样 的 扭矩 。 
本 节 的 其 他 内 容 中 ， 我 们 关注 在 接触 域 具有 指定 压力 
分 布 的 平面 接触 域 的 性 质 。 
为 便于 讨论 ， 可 以 称 接触 物体 中 的 一 个 为 零件 
(例如 ， 地 面 上 的 平整 物体 或 机 器 人 手指 ) ， 其 他 的 
物体 称 为 固定 支撑 。 定 义 一 个 坐标 系 以 便 使 平面 接触 
域 处 于 z=0 的 平面 内 ， 并 设 p(r) 20 为 零件 和 支撑 
间 的 接触 压力 分 布 ,r= (x, y) "作为 位 置 函 数 。 接 触 
域 的 摩擦 系数 为 hw。 如 果 零 件 的 平面 速度 为 1= (@,, 
v,，v,) ， 则 在 位 置 r 处 的 线性 速度 为 v(r) = (v, - 
wy, v, +w.x) ， 且 单位 速度 v(r) 2v(r) /|lv(r) ll 
在 滑动 平面 内 ,在 r 处 由 零件 施加 给 支撑 的 无 穷 小 的 
作用 力 为 


d f(r) =[df.(7),d f(r) ]" »up(r)v(r) 
(27.21) 


零件 施加 到 支撑 上 扭矩 的 总 和 为 ， 
m, xdf,(r) - ydf. Cr) 
w=| Alef] 440 fa 
r2 d f(r) 
(21.22) 
sth, A 为 支撑 域 面积 。 
不 出 所 料 ， 扫 和 矩 与 运动 速度 无 关 ， ET AA GEI 1 
且 所 有 的 w>0， 由 速度 an 产生 的 扭矩 都 是 相同 的 。 
把 式 (27.22) 看 作 旋 量 到 扭矩 的 映射 ， 可 以 将 单位 


旋 量 球体 的 表面 ( (le [|= 1) 映射 到 扭矩 空间 的 表面 。 
该 表面 即 为 封 团 的 外 凸 的 包含 扭矩 空间 原点 的 限定 面 
( 见 图 27. 15) 。 扭 矩 空间 被 限定 面包 含 的 部 分 恰恰 是 
零件 扭矩 可 以 传递 到 支撑 上 的 扭矩 的 集合 。 当 零件 在 
支撑 上 滑动 时 (t 尖 0) ， 且 由 最 大 功 不 等 式 知 ， 接 触 
HE w 位 于 限定 面 上 ， 旋 量 上 垂直 于 在 w 处 的 限定 
面 。 如 果 压 力 分 布 在 各 处 都 是 有 限 的 ， 则 限定 面 是 平 
滑 和 严格 外 凸 的 ， 且 单位 扭转 到 单位 扭矩 的 映射 及 反 
过 来 的 映射 是 一 对 一 且 连 续 的 。 限 定 面 也 满足 式 
w( -£) = - e(t) 的 性 质 。 


图 27.15 为 建立 软 指 限定 面 的 接触 ，CoR AMAR 
用 于 数值 积分 的 无 穷 小 面 域 d4 


27.7.1 在 软 接触 面 上 的 摩擦 限定 面 


按 式 (27.18) 给 定 一 个 压力 分 布 ， 通 过 使 用 式 
(27.12) 和 式 (27.22), ， 可 以 用 数值 法 建立 相应 的 
摩擦 限定 面 。 对 于 无 限 小 接触 域 ， 接 触 类 似 于 点 接 
触 。 所 以 可 以 应 用 库仑 摩擦 定律 。 

接 下 来 ,将 通过 对 称 模型 探索 旋转 中 心 
(CoR) 的 动态 特性 ， 以 制定 圆 形 接 触 域 上 摩擦 力 
和 力矩 的 幅 值 方程 。 图 27. 15 给 出 了 具有 有 瞬时 旋 
转 中 心 的 圆 形 接触 域 。 通 过 沿 着 x 轴 移 动 (或 扫 
fii) CoR， 可 以 获得 不 同 的 摩擦 力 和 力矩 的 组 合用 
来 构建 限定 面 。 更 多 的 详细 内 容 参 见 参 考 文献 
[27.35-38, 42, 77-80]. 

下 面 是 沿 x 轴 在 距离 d. 处 的 旋转 中 心 在 接触 面 上 
关于 摩擦 力 (f) 总 和 和 力矩 (m,) 的 推导 ， 如 图 
27. 15 所 示 。 通 过 在 - oo Bo 范围 内 改变 CoR 的 距离 
d.， 可 以 获得 所 有 可 能 的 Cf, m.) 组 合 以 便 构建 整 
个 摩擦 限定 面 。 

在 整个 接触 域 4 中 ， 通 过 对 可 以 应 用 库仑 摩擦 定 
律 的 每 个 微小 面 域 dA. 的 剪 切 力 的 积分 可 以 获得 整个 
接触 域 的 切 向 力 。 当 考虑 赫兹 接触 压力 分 布 时 :了 ”|， 
Ast (27.18) 中 值 取 k=2。 设 r=(x, y)' 且 r= 
上， 对 式 (27.21) 积分 可 获得 总 的 切 向 力 : 


f. A 
js - | ustr)pC) dà (27. 23) 


step, A 表示 图 27.15 中 的 圆 形 接触 域 ; /为 如 图 
27.15 所 示 的 切 向 力 向 量 的 方向 ; u ERR AM, v 
(r) 为 相对 于 位 置 r 处 的 无 限 小 面 域 d4 上 的 旋转 中 心 
的 速度 向 量 y(r) 方向 上 的 单位 向 量 ，p(r) 为 距 接 
触 中 心 距离 为 + 处 的 压力 分 布 。 由 于 沿 距 接 触 中 心 为 
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r 的 环形 线 上 的 压力 相同 ， 可 以 用 p(r) 代替 p(r)。 
负 号 表示 v(r) 和 上 的 相反 方向 ， 由 于 我 们 主要 关心 
摩擦 力 和 力矩 的 幅 值 ， 在 后 面 的 推导 中 ， 当 考虑 幅 值 
时 可 以 省 略 负 号 。 

同 理 ，z 轴 或 垂直 于 接触 域 的 力矩 为 


m. = | ulrxs(r) pcd 
seh, |r xv(r) | 是 向 量 r 和 v(x) 的 又 乘 的 幅 值 ， 其 
方向 垂直 于 接触 面 。 


单位 向 量 v(r) 与 从 原点 到 从 图 27. 15 所 示 x 轴 
上 选择 的 旋转 中 心 的 距离 4. 有 关 ， 并 可 以 记 为 如 下 


(27.24) 


$9 =— + || 
V(r-ad) «y (x 7d.) 


1 —rsin@ 
( rcosÓ — d,)” + (rsing)’ ~ (reos6 —d.) 
(27.25) 
根据 对 称 性 ， 对 于 沿 x 轴 的 所 有 旋转 中 心 有 f. = 0; 
所 以 ， 在 接触 切 向 平面 内 切 向 力 的 幅 值 为 1 = f. Yd 
sk (27.18) 和 式 (27.25) 代入 式 (27.23) 和 式 


(27. 24) ， 可 以 得 到 
(rcos0 — d, ) N ry F 
f= he He a uf i 


(27.26) 


同 理 ， 关 于 垂直 于 平面 的 坐标 轴 的 力矩 为 : 


2i | " r^ —rd,cos0 : N | ( r ) MT 
5 M td? -2rdcosð — "c a 
(27.27) 


在 式 (27.26) 和 式 (27.27) 中 ,定义 了 极 坐 标 系 ， 
如 xx =recosg，y=rsing Fl dA =rdrdg。 同 时 也 引入 标准 
坐标 系 


= r 
r = — 


从 式 (27.28) 中 ,我 们 可 以 把 d 记 作 dr =ad r , 


也 可 以 把 d, 表示 为 = d./a， 并 假设 在 整个 接触 域 
中 以 为 常数 。 将 标准 坐标 系 代 入 式 (27.26)， 并 目 


(27. 28) 


C, ET ( r^cos0 — r^d,) x ry ta 2 
T? +d, -2 7 d cosh 

(27. 30) 

可 以 对 式 (27.29) 和 式 (27.30) 在 距离 
Hd X d, Add Aul 其 可 在 由 式 
(27.18) 给 定 的 指定 压力 分 布 p(r) 的 极限 面 内 
产生 一 a 封闭 形式 解 可 能 不 存在 ,但 其 可 以 
用 数值 方法 计算 的 两 个 方程 都 涉及 椭圆 积分 。 当 
ln 的 距离 4 在 -om 至 oo 范围 内 变化 时 ， 通 
绘制 摩擦 接触 面 可 以 获得 (f. m.) 所 有 可 能 


27.7.2 构建 摩擦 限定 面 的 示例 


当 压 力 分 布 是 四 阶 的 ， 即 =4， 表 27.3 中 的 参 
BC, = (67/0) (T(3/4)/AT(1/4)) =1.1441， 式 
(27.29) 和 式 (27.30) 可 以 写作 


=o ["[ 


35474 


m. 2s (d 
"axi Í 
(075529 76 


对 于 不 同 d. 值 的 数值 积分 会 产生 关于 f/ 


(uN), m/(auN)) 多 对 点 ， 绘制 这 些 点 如 图 27. 16 
所 示 。 


这 些 数值 解 得 合理 的 近似 值 可 以 由 如 下 的 椭圆 方 


程 表示 
ME 


AP, BARA (m,) ,为 
ee 


N 
= 1- 
Quo [dr | slt 
(27.32) 


( F^ cos 一 Fd.) 


T? + d d c3 7 d „cos0 


( 73 cosh — Pd) 


Ta d? -2 7 d „cos0 


(27.31) 


两 边 同时 除 以 jN， 可 以 推导 出 : 
( P?^cos6 -F d, ) 


f : x(1 
-0 n d? -2 i d,cosó 


i) Fd Fdo 


(27. 29) 
再 次 将 7 =r/a 和 dr=ad 7 代入 式 (27.27) ， 并 除 以 


qu 以 便 标准 化 ， 可 以 得 到 


从 式 (27.27) 中 得 到 d, =0 处 的 旋转 中 心 。 它 在 图 
27. 16 中 定义 了 四 分 之 一 椭圆 曲线 。 这 种 近似 是 构建 
三 维 (3-D) 椭 球 形 限定 面 的 基础 ， 如 图 27.17 所 
示 ， 并 且 是 关于 27. 6. 1 节 所 讲述 的 软 接触 的 很 好 的 
模型 。 更 多 的 详细 内 容 参见 参考 文献 [27. 35-37, 
39, 40, 42, 78]. 
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m; 


标准 作用 力矩 ， 


auN 


06 0.7 08 09 


f tt 
标准 作用 力 ， UN 


图 27. 16 通过 椭圆 近似 和 数值 积分 获得 的 限定 曲面 的 示例 ( 数 
值 积分 是 基于 压力 分 布 p(r) 和 参数 Ci 的 。 在 图 中 ， 取 式 


(27.18) "hk =2 和 k =4 两 种 情况 时 的 压力 分 布 ) 


27.8 抓 取 和 夹 持 器 设计 中 的 接触 


问题 


将 作用 力 与 考虑 接触 变形 的 抓 取 和 夹 持 器 设计 中 
存在 的 接触 位 移 (或 接触 面 变形 ) 联系 起 来 是 很 有 
意义 的 。 而 且 ， 由 于 接触 的 性 质 ， 该 力 一 位 移 是 典型 
的 非 线 性 关系 。 诸 如 胡 克 定律 的 线性 表达 不 能 捕获 这 
些 接 触 类 型 的 力 和 位 移 的 瞬时 关系 和 所 有 的 特征 。 本 
节 总 结 和 讨论 在 弹性 模型 下 的 力 与 位 移 的 关系 。 

从 图 27. 13 和 接触 的 几何 形状 , 式 (27.17) ， 将 
接触 域 半径 和 法 向 力 联系 起 来 ， 该 方程 可 以 改写 。 假 
设 d<< Ro, 式 (27.33) 可 以 从 参考 文献 [27.39] 
推导 出 


N=cd: (27. 33) 
式 中 ,cy 是 比例 系数 ， 且 为 : 
1 
dT (27.34) 


c, FC 都 可 以 通过 实验 获得 。 如 果 指 尖 的 y 已 知 ， 则 
指数 上 也 可 以 通过 y 由 式 (27.34) 获得 。 式 
(27.33) 中 指数 < 的 变化 范围 是 了 <t ER 
(27.33) 中 ， 指 尖 的 途径 或 垂直 下 降 距 离 d 与 增 至 
2y 的 法 向 力 成 比例 关系 (IL (27.34) ) ， 其 中 2y 
E 0 28 2/3 范围 内 变化 。 


pu 


图 27.17 软 指 的 摩擦 限定 面 
a) 3-D 椭 球 形 表示 的 限定 面 b) 椭圆 形 限 定 
面 的 一 部 分 表示 力 和 力矩 的 耦合 关系 


图 27. 18 描述 了 法 向 力 与 接触 位 移 的 关系 ， 该 图 

采用 了 具有 非 线 性 的 寡 律 方程 (27.33 ) 。 当 与 图 

27. 18 对 比 时 ， 其 与 软 指 和 平面 间接 触 的 实验 数据 具 

Fi BRIE 
接触 刚度 Kk, N/mm) 
150 


法 向 力 N/N 
600 


0 1 2 3 4 


5 6 7 
垂直 下 降 位 移 4/mm 


图 27.18 xt (27.33) 中 典型 的 力 一 形变 曲线 作为 右 侧 标 度 ， 
并 且 由 式 (27. 35 ) 给 定 的 接触 刚度 k, 作为 左 侧 标 度 


27.8.1 软 指 的 接触 刚度 


一 个 软 指 的 非 线 性 接触 刚度 定义 为 法 向 力 的 
变化 量 与 接触 处 垂直 负载 的 变化 量 的 比值 。 软 指 
的 接触 刚度 可 以 通过 对 式 (27.33) 求 微分 获得 ， 
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如 下 表 27.5 对 于 线 弹 性 (y =1/3 或 《=372 时 ) 
paN, pt) um 和 非 线 弹性 软 指 的 关于 接触 的 力学 方程 的 总 结 
TOME i mo £ 软 指 公式 5 & 

用 4 = (Z) ERR (27.33) 并 将 其 代入 式 za m" "n 

(27.35), ， 推 导出 : r Y. 

"P 压力 分 布 p) =p(0) [1- (三) F 代表 性 地 £1.8 

k =e TiN T Se PEN (27. 36) 7 

所 以 ， 以 简洁 方式 推导 出 的 软 质 的 非 线性 接触 刚度。 a N=cad xe 

指数 和 法 向 力 与 逼近 的 比值 wd 的 乘积 。 在 图 T 
27. 18 中 绘制 了 典型 的 接 能 刚度 ， 并 作为 和 向 形 变 。。 MMN ndn Tee 


量 的 函数 。 图 中 描述 的 刚度 随 力 的 增加 而 增加 。 作 
为 不 同 参 数 的 函数 的 刚度 的 表达 在 表 27.4 中 总 结 
如 下 。 


表 27.4 接触 刚度 表达 式 总 结 


f(d) SN) 


k; ctds-! 


| 
ca CEN € 


通过 对 式 (27.35) 微分 可 以 获得 刚度 的 变化 
量 ， 以 推导 如 下 公式 


中 


ak. e 
Be Da (27.37) 
ðk, £-1 
aw" d (27.38) 


st (27.35) 表明 : 在 指定 的 指 尖 材料 和 法 向 力 的 变 
化 范围 下 ， 由 于 N/d 的 比值 一 直 在 增 大 ， 所 以 软 指 
的 刚度 也 总 是 增 大 。 这 与 接触 刚度 随 形变 量 和 力 的 增 
大 而 增 大 ( 即 ， 更 加 刚性 化 ) 的 观察 是 一 致 的 。 此 
bh, 3X (27.38) 表明 : 由 于 Ok/9N>0 H.Zz1.5, 
所 以 接触 刚度 总 是 随 法 向 力 而 增加 。 男 外 ， 刚 度 相 
对 法 向 负载 的 变 化 量 与 垂 向 形变 量 d 成 反比 关系 ， 如 
公式 (27.38) 推导 所 示 。 这 些 结论 说 明 : 随 着 法 向 
负载 和 垂 向 形变 量 的 增加 ， 接 触 刚度 增加 的 速率 会 逐 
渐变 得 越 来 越 小 。 

表 27.5 列 出 了 软 指 公式 的 总 结 。 一 般 需 律 方程 
(27.17) 中 的 指数 的 变化 范围 为 0<y<1/3。 赫 兹 接 
触 的 指数 y=1/3; 所 以 ， 对 于 线性 弹性 材料 的 赫兹 
接触 理论 是 式 (27.17) 的 特殊 情况 。 线 性 弹性 材 
料 ， 如 钢 或 其 他 金属 指 尖 ， 在 小 变形 情况 下 ， 一 般 与 
赫兹 接触 理论 匹配 很 好 。 窜 律 方程 (27.17) 应 该 应 
用 到 柔软 材料 制 成 的 指 尖 中 ， 例 如 软 橡胶 或 硅胶 ， 甚 
至 是 黏 弹性 指 尖 。 


27.8.2 ” 软 接触 理论 在 夹 持 器 设计 中 的 应 用 


先前 的 分 析 和 结论 可 以 应 用 到 夹 持 器 的 设计 和 涉 
P NAAA E E 在 采用 软 接 
触 〈 例 如 ， 铜 表面 ) 的 夹 持 器 的 设计 中 ， 在 相对 较 
大 的 变形 和 负载 下 ， 应 该 考虑 用 表 27.5 7) h mE 
方程 代替 赫 效 接触 方程 。 在 这 些 情况 下 ， 赫 效 接触 模 
型 不 再 精确 ， 并 应 该 被 替换 掉 。 另 一 方面 ， 在 相对 较 
小 的 变形 情况 下 (d/R,«595), ， 如 果 在 夹 持 器 的 设 
计 中 采用 线性 弹性 材料 ， 当 应 用 接触 理论 时 ， 指 数 应 
该 取 作 y=1/3。 此 外 ， 发 现 指 数 y 一 般 是 由 材料 决 
定 的 而 不 是 由 外 形 决 定 的 3 济 。 一 旦 由 材料 确定 了 

HX y 的 取 值 (例如 ， 参 考 文献 [27.38] 使 用 拉 伸 
试验 机 开展 实验 过 程 ) ， 它 可 以 与 采用 的 相关 方程 一 
起 进行 夹 持 器 设计 的 分 析 。 


ud 


27.9 结论 与 扩展 阅读 


本 章 中 ， 对 接触 表面 的 刚体 和 弹性 模型 进行 了 讨 
论 ， 其 中 包括 接触 扭矩 和 扭转 间 的 运动 学 约束 和 对 偶 
性 。 采 用 库仑 摩擦 对 可 能 产生 的 接触 力 进行 了 描述 。 
提出 了 在 刚体 和 库仑 摩擦 模型 下 的 多 接触 操作 任务 。 
引入 了 摩擦 限定 面 并 用 来 分 析 推 操作 问题 。 提 供 了 
个 基于 软 接触 表面 的 力 / 力 矩 方程 的 软 接触 摩擦 限定 
面 的 例子 。 采 用 接触 面 的 建 模 方法 提出 了 把 这 些 接触 
模型 应 用 到 夹 持 器 的 分 析 和 设计 中 。 本 章 的 文献 目录 
中 的 许多 参考 文献 提供 了 关于 这 个 问题 的 进一步 
阅读 。 

操作 模型 包括 抓 取 ， 推 送 ， 滚 动 ， 拍 击 ， 投 掷 ， 
Hoe, Pew, LA RH fh AHS AY ME Hh AS A oh AS HR 
PECTS) 。 本 章 提出 了 接触 模型 表面 的 概述 ， 重 点 关 
注 它 们 在 操作 任务 中 的 应 用 ， 包 括 无 法 抓 取 的 或 不 适 
合 抓 取 的 操作 模式 ， 例 如 推 操作 。 同 时 提供 了 抓 取 和 
加 持 操 作 的 分 析 。Mason 的 教材 中 在 本 章 扩展 了 一 
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系列 理论 ， 包 括 凸 多 面 锥 体 理论 ， 平 面 问题 的 图 解法 


以 及 在 操作 规划 问题 中 的 应 
[27.82] PALA FSH 


用 。 在 参考 文献 
锥 体 的 基础 材料 ， 在 


参考 文献 【27. 10，83-85] 中 介绍 了 扭转 和 扭矩 的 
表达 方式 的 应 用 。 扭 转 和 扭矩 是 经 典 旋 量 理论 的 基本 


元 素 ， 旋 量 理论 在 参考 文献 [27.86, 87] 中 有 所 介 
绍 ， 并 在 参考 文献 [27.30, 88, 89] 中 从 机 器 人 角 


度 介绍 了 旋 量 理论 。 


此 外 ， 这 本 手册 的 几 个 相关 章节 提供 了 进 


步 的 


理论 和 应 用 的 阅读 ， 例 如 第 1 章 和 第 28 章 。 
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SOON if 


本 章 介绍 抓 取 分 析 的 基本 模型 。 该 整体 模型 是 
诸多 模型 的 耦合 ， 它 们 定义 了 广泛 应 用 在 刚体 运动 
学 和 动力 学 模型 中 的 接触 行为 。 该 接触 模型 本 质 上 
归结 于 通过 各 接触 所 传递 的 接触 力 和 力矩 分 量 的 选 
择 。 由 完整 模型 的 数学 性 质 可 以 自然 地 引出 五 种 基 
本 的 抓 取 类 型 ,它们 的 物理 解释 为 抓 取 和 操作 规划 
提供 了 深入 了 解 。 

在 对 基本 原理 和 抓 取 类 型 进行 介绍 之 后 ， 这 一 
章 着 重 于 介绍 最 重要 的 抓 取 特 征 : 完全 约束 。 一 个 
带 有 完全 约束 的 抓 取 可 以 防止 失去 接触 ， 因 而 是 很 
安全 的 。 两 个 主要 的 约束 特性 是 形 封 闭 和 力 封 闭 。 
一 个 形 封 闭 的 抓 取 保证 了 只 要 手 的 指 杆 和 抓 取 目 标 
近似 为 刚性 及 只 要 关节 驱动 器 足够 强大 ， 接 触 就 可 
以 维持 。 正 如 将 要 看 到 的 ， 形 封闭 和 力 封 闭 抓 取 之 
间 的 主要 区 别 在 于 后 者 依赖 于 接触 摩擦 。 这 意味 着 
达到 力 封 闭 比 达到 形 封闭 需要 更 少 的 接触 。 


机 械 手 的 开发 是 为 了 使 机 器 人 拥有 抓 取 不 同 
几何 和 物理 属性 物品 的 能 力 。 第 一 个 机 器 人 灵巧 
手 是 索 尔 兹 伯 里 手 !* 路。 它 有 三 只 三 关节 手指 ， 
足以 控制 一 个 对 象 的 所 有 6 个 自由 度 和 抓 取 力 。 
由 索 尔 效 伯 里 完成 的 基本 抓 取 模 型 和 分 析 提 供 了 
一 个 沿用 到 今天 的 抓 取 合成 与 灵巧 控制 研究 的 基 
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28.2 模型 与 定义 


抓 取 过 程 的 数学 模型 必须 能 够 预测 在 抓 取 实物 过 
程 中 可 能 发 生 的 各 种 载荷 条 件 下 手 和 目标 的 动作 行 
为 。 一 般 而 言 ， 最 通常 的 动作 是 保持 这 样 一 种 抓 取 情 
Bb. 当面 对 作用 于 物体 上 的 未 知 扰动 力 和 力矩 仍 保持 
抓 取 状 态 。 通 常 这 些 扰 动 来 自 于 惯性 力 ， 它 会 在 高 速 
或 者 由 重力 产生 的 作用 力 下 变 大 。 抓 取 的 保持 意味 着 


础 。 其 中 一 些 最 成 熟 的 分 析 技 术 已 经 被 各 人 到 了 
软件 Grasp! 24 PS? , Grasplt! 中 包含 了 一 些 
机 械 手 的 模型 ， 并 且 提 供 了 抓 取 选择 、 动 力学 的 
抓 取 仿真 和 图 像 生 成 的 工具 。 

这 一 章 的 目标 是 对 形 封闭 和 力 封闭 最 重要 的 抓 取 
特性 给 出 透彻 的 解释 。 这 些 将 会 贯穿 在 讲解 抓 取 模型 


灵巧 手 的 接触 面 必须 要 避免 接触 分 离 和 不 必要 的 接触 
滑动 。 这 种 特殊 类 型 的 抓 取 (封闭 式 抓 取 ) 会 被 保 
持 在 每 一 个 可 能 的 扰动 载荷 上 。 图 28. 1 展示 了 索 尔 
禾 伯 里 手 "中 对 一 个 物体 执行 一 个 封闭 式 抓 取 ， 它 
把 它 的 手指 包 右 在 物体 周围 并 且 用 手掌 压 在 这 个 物体 
上 面 。 针 对 封闭 抓 取 的 正式 定义 、 分 析 以 及 计算 测试 


的 详细 起 源 和 对 具体 事例 的 讨论 当中 。 通 过 深入 了 解 
历史 和 文献 资料 的 宝库 确定 了 抓 取 的 宽度 与 广度 ， 读 
者 可 查阅 参考 文献 [28. 3]。 


将 会 在 28.5 节 中 列 出 。 
图 28. 2 列举 了 将 会 在 模拟 抓 取 系统 中 用 到 的 
些 主要 变量 。 假设 机 械 手 的 指 杆 和 物体 都 是 刚性 的 ， 
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图 28.1 索 尔 交 伯 里 手 抓 取 一 个 物体 


而 且 有 一 个 独特 的 能 表明 各 接触 点 的 切 平面 。 用 


iN 


| 代表 一 个 方便 选择 的 固定 在 工作 空 


间 的 惯性 坐 


标 系 。 坐 标 系 DB) 固定 在 物体 上 ， 这 一 坐标 系 的 


原始 定义 通过 


来 ,其 中 R“ 表示 三 维 几 何 空 


方法 是 把 向 量 P 了 的 原点 取 在 物体 的 
| 中 接触 点 的 位 置 i 由 矢量 ee R” 定义。 在 
接触 点 i 处 ,我 们 定义 一 个 坐标 系 | 


系 有 轴 in, 


A IN 


tf,, 0,} ($60. 


间 。 


出 


量 PeR” 和 坐标 系 |N) 联系 起 


一 个 便捷 的 处 理 
质心 处 。 在 坐标 


C1 ;， 这 个 坐标 


1 现在 分 解 图 中 ) 。e， 


TUE. HE, HT-[n-0nJ'eR'cmX R 
荷 〈 柱 状 关节 中 的 力 和 回转 关节 中 的 力 抢 ) 。 这 些 
载荷 产生 于 执行 机 构 的 作用 力 、 其 他 作用 力 和 惯 
性 力 。 它 们 同样 也 可 以 产生 于 物体 和 机 械 手 之 间 
的 接触 。 然 而 ， 一 种 理想 的 做 法 是 把 关节 的 载荷 
分 离 为 两 个 部 分 : 由 接触 产生 的 是 一 部 分 ， 其 他 
来 源 的 是 另 一 部 分 。 在 整个 章节 里 ， 非 接触 的 载 
荷 将 被 表示 为 T。 

用 ueR" 表 示 坐 标 系 | BI 和 坐标 系 {N} 的 位 
置 方 向 关系 向 量 。 对 于 平面 系统 来 说 n, =3。 对 于 三 
维 空间 系统 ，n,, 有 不 少 于 3 个 参数 用 来 描述 目标 ， 
一 般 来 说 是 3 个 (对 欧 拉 角 ) 或 4 个 (对 单位 四 元 
数 ) 。 在 坐标 系 IN) 中 ， 物 体 的 转动 由 v=[v'w |" e 
RRI, CHA p 的 平移 速度 ve R” 和 物体 的 角 速 
度 wsR 合成 ,而 二 者 均 在 坐标 系 IN) PRA, 
刚体 的 转动 可 以 表示 为 固 接 于 该 物体 的 任何 方便 的 
坐标 系 上 。 前 面 提 到 的 转动 的 部 分 包含 了 新 坐标 系 
原点 的 速度 和 物体 的 角速度 ， 均 表示 在 新 坐标 系 中 。 
关于 转动 和 扭转 的 严格 推导 见 参 考 文献 [28.5, 
6]。 请 注意 ， 对 于 平面 系统 来 说 veR ”, oeR, Br 
VÀ n, 23, 

另 一 个 重要 的 点 是 : a ctv, Mita, x 
些 变量 可 以 利用 和 矩阵 了 和 下 面 式 子 联系 起 来 


的 单位 向 量 n; 正 交 于 接触 切 平面 ， 并 直接 指向 物 
体 。 另 外 两 个 单位 向 量 相互 正 交 并 且 处 于 接触 切 平 


u-VW 


(28.1) 


面 内 。 


ES 


图 28.2 抓 取 分 析 的 主要 工程 量 


将 关节 从 1 Bln, 编号 。 用 g = [gi… 
”表示 关节 位 移 的 向 量 ， 其 中 上 标 了 表示 矩阵 的 


COME. 


式 中 ， XR [e V e R xv 


并 非 一 般 的 方 阵 ， 


它 满足 


VVP, ÆRMER, JHI TER u 的 点 意 
味 着 时 间 上 的 不 同 。 请 注意 ， 对 于 平面 系统 ，VY = 
IcR?**, 

feR'ANTEHTEVIK E p 点 的 力 ， 
R ”为 作用 力矩 。 这 些 符号 (m) 在 坐标 系 IN | 
中 表示 ， 他 们 同 物体 的 载荷 或 扭转 结合 ， 并 用 g = 
[fim ]"e 民 “表示 出 来 。 就 像 转 动 一 样 ， 扭 转 也 可 
以 用 任何 合适 的 固定 在 物体 上 的 坐标 系 表 示 出 来 。 你 
可 以 把 这 一 过 程 看 做 是 对 力 的 作用 线 的 变换 ， 直 到 它 
通过 了 新 的 坐标 系 的 原点 ， 然 后 调整 扭转 力矩 的 分 
量 ， 通 过 将 这 一 分 量 移动 到 力 的 作用 线 上 以 抵消 力矩 
的 作用 。 最 后 ， 将 力 和 经 过 移动 的 力矩 表示 在 新 的 坐 
标 系 下 。 在 完成 了 连接 的 载荷 之 后 ， 物 体 的 扭转 将 被 
分 为 两 个 主要 的 部 分 : 接触 和 非 接触 扭转 。 在 这 一 章 
里 , 将 用 g 表示 物体 上 的 非 接触 扭转 。 


度 运动 学 


这 一 童 的 内 容 对 于 很 多 种 类 的 机 械 手臂 和 其 他 抓 
取 机 械 机 构 都 是 有 效 的 。 并 且 我 们 假设 这 一 类 机 械 手 


me 


28.2.1 ik 
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都 含有 一 个 “手掌 ”作为 基底 ， 上 面 有 若干 数量 的 
手指 ， 每 一 个 手指 都 有 若干 个 关节 。 这 一 章 中 给 出 的 
构想 会 被 非常 明确 地 表达 出 来 ， 不 仅仅 就 弯曲 的 和 直 
线 的 关节 而 言 。 大 多 数 其 他 的 常见 的 关节 都 可 以 由 这 
两 种 关节 建立 模型 (例如 圆柱 状 的 、 球 状 的 和 平面 
状 的 关节 ) 。 任 何 数量 的 接触 可 能 发 生 在 任何 数量 的 
连 杆 和 物体 之 间 。 

1. 抓 取 和 矩阵 和 机 械 手 雅 可 比 和 矩阵 

有 两 个 和 矩阵 在 抓 取 分 析 过 程 中 极为 重要 : 抓 取 矩 
HE G 和 机 械 手 雅 可 比 矩 阵 J。 这 些 和 矩阵 定义 了 相对 速 
度 运动 学 以 及 接触 的 力 传递 特性 。 接 下 来 对 G 和 J 
进一步 的 讨论 将 会 建立 在 三 维系 统 的 情况 下 。 对 于 向 
平面 系统 的 转换 将 会 在 之 后 进行 。 
每 一 个 接触 应 当 被 视 作 两 个 重合 点 : 一 个 在 机 械 
手 上 ， 男 一 个 在 物体 上 。 机 械 手 雅 可 比 和 矩阵 描绘 了 表 
示 在 接触 坐标 系 内 的 机 械 手 转动 的 关节 速度 ， 抓 取 拢 
阵 的 转 置 依赖 于 物体 转动 在 接触 坐标 系 内 的 表示 。 在 
机 械 手 的 每 一 个 指 村 上， 手指 关节 的 动作 均 带 来 一 个 
刚体 的 运动 。 机 械 手 的 转动 ， 顾 名 思 义 ， 这 里 提 到 的 
接触 i 的 转动 是 接触 i 处 指 杆 的 转动 所 参与 的 接触 i。 
这 样 ， 这 些 矩 阵 可 以 通过 改变 表示 转动 的 参考 坐标 系 
的 方式 得 以 相互 转化 。 抓 取 分 析 的 基本 符号 见 
表 28.1。 


表 28.1 抓 取 分 析 的 主要 符号 


符 号 E X 
n, 接触 的 数量 
n, 机 械 手 的 关节 数量 
n, 物体 的 自由 度数 量 
qeR” 关节 位 移 
q eR" 关节 速度 
TeR" 非 接触 关节 载荷 
ueR 物体 位 置 和 姿态 
veR 物体 转动 
geR 非 接 触 物体 扭转 
{B} 物体 坐标 系 
ICI; KH i E 
IN} 惯性 坐标 系 


为 了 导出 抓 取 和 矩阵 ， 令 表示 在 坐标 系 (N] 中 的 
ww 为 物体 的 角速度 ， 同 样 令 表示 在 坐标 系 QN] 中 
WI vi AWER (EÈ (Ch 的 原点 ) 的 速度 。 
这 些 速度 可 以 从 表示 在 坐标 系 |N| 中 的 物体 转动 中 


获得 : 


(28.2) 
式 中 ， 
I x3 0 
Ps (28.3) 
"i -p) 2 


L,,cR 是 一 个 单位 矩阵 ; S(c, - p) 是 一 个 又 积 
和 矩阵 ， 这 就 是 说 ， 给 定 一 个 三 维 向 量 r= [rrr], 
S(r) 定 义 为 


S(r) =] r, 0 -r, 

-r, r. 0 
在 (C), 中 所 指 物体 的 转动 仅仅 是 式 (28.2) 中 
的 左手 一 边 的 表示 在 (Ch PAE, SR, = [n 
8.0] eR ”“， 它 代 表 了 第 i 个 接触 坐标 系 |C), 相 
对 于 惯性 坐标 系 的 姿态 (单位 向 量 mu, f, Lo, 
坐标 系 QN] 中 的 表达 )。 然 后 给 出 物体 转动 在 


1C 的 表达 
ELT 
Vi, obj -R, | 
0j 


R, 0 
式 中 , R,-Blockdiag (R;, R;) -| 上 R 5。 


(28.4) 


0 R, 
将 Piv Wak (28.2) 代入 到 式 (28.4) 带 来 局 部 


的 抓 取 和 矩阵 G! e Rs*， 它 描绘 了 物体 转动 从 IN) 
到 (CJ, 的 转化 


NETT (28.5) 


式 中 ， G'=RP" (28. 6) 

机 械 手 雅 可 比 矩 阵 可 以 用 相似 的 方法 推 得 。 令 
ww 为 机 械 手 在 接触 点 i 的 接触 物体 的 连 杆 的 角 速 
度 ， 表 示 在 IN) 中 ; 令 由 为 机 械 手 上 的 接触 了 的 
平移 速度 ， 表 示 在 QN] 中 。 这 些 速 度 通 过 和 矩阵 Z, 
同 关节 速度 相关 联 ，Z, 的 纵向 是 关节 的 普 吕 克 坐 标 
NS, BRAT LS 


(28.7) 
IP, Z eR‘ nI (28.8) EM: 
d; , dd din, 
Z, = ' 
li) d I, 
ee 如 果 接 触 了 不 影响 关节 7 


如 果 关节 j 是 平移 关节 
Sa- URAY j 是 旋转 关节 


(28.8) 
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03 51 如 果 接 触 i 不 影响 关节 j 
1, = 4931 如 果 关 节 7 是 平移 关节 
Zz, 如 果 关 节 7 是 旋转 关节 


如 图 28. 11 所 示 , E, 是 关联 于 第 7 个 关节 的 坐标 
系 的 原点 , z) 是 同一 坐标 系 中 沿 z 轴 的 单位 矢量 。 两 
个 向 量 都 表示 在 坐标 系 |N) 中 。 这 些 坐 标 系 可 以 用 
任何 合适 的 方法 指定 ， 例 如 Denavit- Hartenberg 
(D-H) PE, z, 轴 是 旋转 关节 的 旋转 轴 和 平移 关 
节 的 平移 方向 。 

将 机 械 手 的 转动 放 在 接触 坐标 系 中 的 最 后 一 步 ， 


也 就 是 把 ww 和 ww 表示 在 坐标 系 LC], 中 
人 ad 
Visa =R; x (28.9) 
O; hnd 


联 式 (28.9) 和 式 (28.7) 推出 局 部 机 械 手 雅 可 
EIERE J,e R5*"%， 它 确定 了 关节 速度 和 机 械 手 接触 
旋转 的 关系 

mg (28. 10) 
J, =RZ, (28. 11) 

为 了 简化 表达 ， 将 所 有 的 机 械 手 和 物体 的 转动 都 
AHE v, pa RAY, e RR 中 ， 如 下 所 示 

vag = Opera), €={obj,hnd} 

现在 完整 的 抓 取 和 矩阵 G e R “6 和 完整 的 机 械 手 


PETI HEERE J e R “ex% 涉 及 的 各 种 速度 量 如 下 


Vi = Gr (28. 12) 
Va 7 J d (28.13) 
式 中 ， 
G! J, 
G'=| : | J= (28. 14) 
GT. Pw 
这 里 的 术语 “完整 ”是 用 来 强调 接触 中 的 所 有 


6n, 个 转动 分 量 都 包含 在 上 述 映射 之 中 。 详 见 本 章 最 
后 的 “ 例 1 第 一 部 分 ”和 “ 例 3 第 一 部 分 ”。 

2. 接触 建 模 

三 个 用 于 抓 取 分 析 的 接触 模型 会 在 这 里 提 及 。 关 
于 机 器 人 接触 建 模 的 完整 讨论 ， 读 者 可 参见 第 27 章 。 

已 知 的 抓 取 分 析 的 三 个 最 重要 的 模型 分 别 是 : 
“无 摩擦 点 接触 ",，“ 硬 手指 ”和 “ 软 手 指 "'*” = 
个 模型 通过 选择 接触 旋转 的 分 量 ， 在 机 械 手 和 物体 间 
传递 。 这 是 通过 将 机 械 手 和 物体 的 接触 转动 分 量 等 效 


的 方法 得 以 实现 的 。 与 其 相对 应 的 接触 力 和 力矩 的 分 
量 也 同样 是 等 效 的 ， 但 是 这 里 并 不 包括 那些 由 接触 单 
侧 性 和 摩擦 模 型 施加 的 约束 (28.5.2 5). 

无 摩擦 点 接触 (Pwok) 模型 适用 于 接触 点 非常 
小 、 机 械 手 与 物体 比较 光滑 的 情况 。 在 这 种 模型 中 ， 
只 有 机 械 手 上 接触 点 以 平移 速度 法 向 分 量 (例如 
yw 的 第 一 个 分 量 ) 作用 于 物体 上 。 切 向 速度 的 两 个 
分 量 和 角速度 的 三 个 分 量 并 不 作用 。 类 似 地 ， 接 触 力 
的 法 向 分 量 作用 于 物体 ， 但 是 摩擦 力 和 力矩 假设 可 以 
忽略 不 计 。 

硬 手 指 (HF) 模型 适用 于 存在 不 可 忽略 的 接触 
摩擦 ,但 接触 点 很 小 的 情况 ,这样 就 没有 明显 的 摩擦 
力矩 存在 。 当 这 种 模型 被 用 于 一 个 接触 时 ， 机 械 手 上 
的 全 部 三 个 平移 速度 分 量 (例如 vj 中 的 前 三 个 分 
E) 和 全 部 三 个 接触 力 分 量 通过 这 一 接触 作用 于 物 
体 。 没 有 任何 角速度 和 力矩 分 量 作 用 。 
软 手 指 (SE) 模型 适用 于 当 表 面 摩擦 和 接触 点 
足够 大 以 至 于 产生 了 可 观 的 摩擦 力 和 一 个 正 交 于 接触 
点 的 摩擦 力矩 的 情况 。 对 于 一 个 适用 于 这 种 模型 的 接 
触 来 说 ， 接 触 的 三 个 平移 速度 分 量 和 角速度 在 接触 点 
处 的 法 向 分 量 会 通过 接触 点 传递 作用 于 物体 上 (Cl 
AN Vi ma KHOU dt) 。 同 样 ， 接 触 力 的 全 部 三 个 分 
量 和 接触 力矩 的 法 向 分 量 通过 接触 被 传递 。 

注意 : 读者 可 能 会 看 到 刚体 假设 和 软 手 指 模型 之 
间 的 矛盾 。 刚 体 假设 是 一 种 对 抓 取 分 析 的 全 方位 的 简 
化 近似 ,但 是 尽管 如 此 ， 这 种 近似 在 许多 实际 情况 中 
仍 是 足够 精确 的 ， 所 以 这 种 抓 取 分 析 并 非 不 切实 际 。 
另 一 方面 ， 对 于 柔性 手指 模型 的 需求 表明 了 手指 杆 和 
物体 并 非 刚 性 的 。 可 是 它 可 以 有 效 地 应 用 于 需要 获得 
大 量 接触 点 的 变形 量 较 小 的 情况 。 这 种 情况 发 生 在 局 
部 表面 几何 形状 相似 的 条 件 下 。 如 果 大 的 手指 或 骨架 
变形 在 真实 的 系统 中 存在 ， 那 么 本 章 中 提 及 的 刚体 处 
理 方 法 要 谨慎 使 用 。 

为 了 展开 PwoF ，HF， 和 SF 模型 ,定义 接触 i 处 
的 相对 转动 为 


~ sr f9 
CJ; -Gi ) Á Jenz =E 


EME H, e 民生 定义 一 个 特殊 接触 模型 ， 这 
个 矩阵 选择 了 相对 接触 转动 的 分 量 忆 并 把 它们 设置 
为 0: 


i, hne 


这 些 分 量 被 认为 是 传递 自由 度 (DOF). H H, XE 


(28. 15) 


[Ez 


0 Hy 
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其 中 Ay 和 Hn 依次 为 选择 和 矩阵 的 平移 和 旋转 分 
量 。 表 28.2 给 出 了 三 种 接触 模型 的 选择 矩阵 的 定义 ， 
表 里 空 集 的 意思 是 式 (28.15) 中 相应 的 分 块 行 矩 阵 
为 空 〈 例 如 它 有 0 行 0 列 )。 请 注意 ， 对 于 SF 模型 ， 


Hy 为 选择 接触 点 的 法 向 旋转 。 
表 28.2 三 种 接触 模型 的 选择 矩阵 
l; Hy Hy 
PwoF 1 (100) 空 集 
HF 3 Ls 空 集 
SF 4 La (100) 
在 为 每 一 个 接触 选择 了 转化 模型 之 后 ， 全 部 n. 
个 接触 的 接触 约束 方程 可 以 写成 如 下 紧凑 形式 : 


Av. ana Veo) =0 (28. 16) 
式 中 , H -Blockdiag (H,, ，…， H,) ERE. 
通过 nn 个 接触 的 转动 分 量 的 数量 1 由 71= ELAH 
最 后 ,将 式 (28.12) 和 式 (28.13) 带 入 式 
(28. 16) ， 我 们 可 以 得 到 


g-e ($ Jeo (28.17) 

y 

AP, Pee ALE HE AT EAR IAE ZEE 
G'-HG'ceR'"5, JeHJeR™™ (28.18) 


对 于 五 (QWUBOBEE) 和 机 械 手 雅 可 比 和 矩阵 结构 
的 更 多 细节 ， 读 者 可 以 参见 参考 文献 [28. 10-12] 。 

参见 “ 例 1 第 二 部 分 ”和 “ 例 3 第 二 部 分 ”。 

值得 注意 的 是 式 (28. 17) 可 以 写成 以 下 形式 

JI =V md ee Ca (28. 19) 

式 中 ,ya 和 vw 只 包含 通过 接触 传递 的 转动 分 量 。 
注意 到 这 个 等 式 意味 着 抓 取 矩阵 的 保持 性 可 以 解释 为 
等 式 的 成 立 可 以 保持 一 段 时 间 。 当 接触 无 摩擦 时 ， 接 
触 的 保持 性 意味 着 持续 的 接触 ， 所 以 滑动 是 允许 的 。 
然而 ， 当 接触 为 HF 类 型 时 ， 接 触 的 保持 性 意味 着 有 
黏 性 的 接触 ， 所 以 滑 移 会 对 HF 模型 造成 干扰 。 同 
样 ， 对 于 SF 类 型 的 接触 ， 可 能 就 没有 关于 接触 点 法 
向 的 滑 移 或 相对 转动 了 。 

在 本 章 剩余 的 内 容 里 ,我 们 假设 wma = Vooo 
所 以 ， 这 个 符号 将 会 被 缩写 为 w。。 

3. 平面 简化 

假设 运动 平面 为 属于 (NI 的 (x, y) 平面 。 向 
量 y 和 g 通过 去 掉 第 3，4，5 个 坐标 分 量 ， 将 维 数 从 
6 维 减 少 到 3 维 。 向 量 c, 和 pp 的 维 数 从 3 维 减 少 至 


hee 


Alt, 的 第 3 个 坐标 分 量 被 去 掉 ) 并 且 式 (28.4) 包 
£ R, =Blockdiag(R,, 1) eR??, xt (28.2) 包含 


Ly 0 
P= 
S,(¢,-p) 1 


AP, SÆRT HAE EARE ERA, ELK 


S,(r) =( -rr,) 
x (28.7) 中 包含 d,,e R^ WIL, eR ,解释 为 
0, 如 果 接 触 力 i 不 影响 关节 j 
dij= Az; 如 果 关 节 j 是 平移 关节 
S(c,-£,)' 如 果 关 节 j 是 旋转 关节 


0 ”如 果 接 触 力 i 不 影响 关节 j 
1 ;=40 WRT) 是 平移 关节 
1 ”如 果 关 节 j 是 旋转 关节 
完整 的 抓 取 和 矩阵 和 机 械 手 雅 可 比 矩 阵 减少 了 尺寸 : 


G! e RF J cR C 
就 接触 约束 而 言 ， 式 (28.15) 就 包含 表 28. 3 中 
的 A, All Hyo 


表 28.3 平面 接触 模型 的 选择 矩阵 


模型 L; Hy Hay 
PwoF 1 (10) 空 集 
HE/SF 2 hyo 空 集 


在 平面 状态 下 ， 因 为 物体 和 手 位 于 同一 平面 内 ， 
所 以 模型 SF 和 HF 是 等 价 的 。 对 于 接触 点 法 向 的 旋 
转 将 会 引起 平面 外 的 运动 。 最 终 ， 抓 取 和 矩阵 和 机 械 手 
雅 可 比 矩 阵 的 维 数 将 会 减少 到 以 下 尺寸 : G'eR'? 
和 JeR“”。 参 见 “ 例 1 第 三 部 分 ”和 “ 例 2 第 一 
部 分 ”。 


28.2.2 ”动力 学 与 平衡 
系统 动力 学 的 等 式 可 以 写 为 


Mala) 4 +bia(q,q ) +S A = Taw 
(28. 20) 


M, (u)v +b,,(u,v) -GA-g,, 
受 式 (28. 17) 约束 
SUP, Mma) WMC) 为 对 称 正定 惯性 矩阵 ; 
bar.) Moby +, +) 为 速度 产生 项 ，g,,, 为 通 
过 重力 和 其 他 外 力 施 加 到 物体 上 的 力 和 力矩 ;Fan 为 
外 部 载荷 和 执行 机 构 运 动 的 向 量 ; 向量 GA 为 通过 机 
械 手 施加 在 物体 上 的 总 扭转 向 量 。 向 量 和 包含 了 接 
触 力 和 通过 接触 传递 力矩 的 分 量 并 且 在 接触 坐标 系 中 


维 。 第 i 个 旋转 矩阵 变 为 R= (nf,) eR?" OXE n, 


得 以 表达 。 特 别 是 ， A = [ATAT T, RPH A, =H, 
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Lf. Sn f m; Mi Mio l. 下 标 表 明 了 一 个 法 向 (n) 和 
接触 力 太 与 力矩 m 的 两 个 切 向 (t, o) 坐标 分 量 。 对 
C SF, HF 或 PwoF 类 型 的 接触 ， 表 28.4 对 A 做 出 了 
规定 。 最 后 ， 值 得 注意 的 是 G,A, =G HA 为 通过 接触 
i 传递 的 扭转 ,其 中 的 G, fu HH, 在 式 (28.6) 和 式 
(28.15) FPEX., HEA, 被 称 为 接触 i 的 扭转 强度 向 量 。 

表 28.4 接触 力 和 力矩 分 量 的 向 量 ， 

也 称 为 通过 接触 i 传递 的 扭转 强度 向 量 


模 型 ^; 
PwoF (fin) 
HF Giff)" 
SF Ufiafifin) 


IN (28.20) 表征 了 手 和 物体 的 动力 学 关系 ， 其 
中 没有 考虑 接触 模型 对 运动 的 约束 。 联 立 这 些 方程 
组 ， 则 系统 的 动力 学 模型 可 以 写 为 


T T 
Cs Q (28.21) 
受 约束 于 Jq =G'v =v, Hip 
T-To ~ Ma(g) F -balg d) 
8 7E. - M, (u)v -b (u, v) (28.22) 


需要 注意 的 一 点 是 动力 学 等 式 和 式 (28.17) 中 
BRARTI SUUS BASEN, FEIJE J fü G^ 只 传 
递 接 触 扭 矩 的 所 选 分 量 时 ， 式 (28.20) PAY J" AG 
用 于 传递 接触 扭转 中 的 相应 部 分 。 

当 其 中 的 惯性 项 可 以 忽略 时 ， 如 发 生 在 缓慢 移动 
中 ,系统 被 认为 是 准 静 态 的。 在 这 种 情况 下 ， 式 
(28. 22) 变 为 


Es 


N 
/ 


T =Tapp £72, (28.23) 
并 且 不 依赖 于 关节 和 物体 的 速度 。 因 此 ， 当 抓 取 为 静 
态 平 衡 或 准 静 态 运 动 时 ， 可 以 通过 式 (28.21) 独立 
求解 第 一 项 和 约束 来 计算 A，g 和 v。 值 得 注意 的 是 
当 动 态 效果 很 明显 时 ， 这 样 的 力 / 速 度 解 耦 的 解 是 不 
可 能 的 ， 尽 管 式 (28.21) 中 的 第 一 项 随 式 (28. 22) 
第 三 项 而 定 。 
注意 : 式 (28.21) 突出 强调 了 关于 抓 取 和 机 械 手 
雅 可 比 和 矩阵 的 一 个 重要 的 替代 观点 。G 可 以 理解 
为 从 被 传递 的 接触 力 和 力矩 到 手 接 触 物体 时 的 一 
系列 扭转 集合 的 映射 。 而 三 可 以 理解 为 一 个 从 所 
传递 的 接触 力 和 力矩 到 关节 载荷 向 量 的 映射 。 注 


28.3 可 控制 的 转动 和 扭转 


在 手 的 设计 和 其 抓 取 与 操作 规划 中 ， 重 要 的 是 知 
道 通过 手指 动作 给 予 物体 的 转动 集合 ， 以 及 在 什么 条 
件 FR" 中 的 任意 扭转 均 能 通过 接触 被 应 用 于 物体 上 。 
这 种 知识 将 会 通过 学 习 与 G AT 相关 联 的 不 同 
子 空间 而 获得 。 

在 图 28.3 中 显示 的 空 


间 是 列 空间 和 G、G”、J 


与 中 中 的 零 空间 。 列 空间 和 零 空间 分 别 记 为 R(: ) 
和 N(“' ) 。 箭 头 表示 了 通过 抓 取 系 统 的 各 种 不 同 的 速 


度 和 负载 量 的 传递 。 例 如 ， 在 图 28.3 的 左 侧 ， 就 说 
明了 任意 向 量 q e R"% 是 如 何 被 分 解 为 在 R(J) 和 
NJ) 中 两 个 正 交 向 量 之 和 的 ， 以 及 4 是 如 何 通 过 
乘 以 了 被 映射 到 R(J) 上 的 。 


接触 转动 
Vee € R/ 


关节 载荷 
te R” 


图 28.3 抓 取 系统 中 转动 向 量 和 扭转 向 量 关系 的 线性 映射 


扭转 强度 
AeR 


这 里 从 线性 代数 中 回忆 两 个 事实 是 很 重要 的 。 首 
， 和 矩阵 A 是 向 量 从 R(A') 映射 到 RCA) 的 矩阵 ， 
射 是 一 一 对 应 的 ， 这 就 是 说 映射 A 是 个 双向 单 映 
A 的 广义 道 矩阵 4 是 双向 单 映射 的 ， 它 将 向 量 
TENA ATT 875, Bah, A 将 向 量 从 NCG") 
射 到 零 向 量 。 最后， 不 存在 能 被 4 映射 到 N(A') 
的 非 平凡 向 量 。 这 说 明了 ， 如 果 N(G') 是 非 平凡 
， 那 么 机 械 手 将 不 能 够 控制 物体 运动 的 所 有 自由 
这 对 于 准 静 态 的 抓 取 当然 是 正确 的 ， 但 当 动态 效 
显著 时 ， eee eG FF 


En I 


Am o 


EES eS 


R 


Th 


i 
P n 


28.3.1 IME 
四 个 零 空 间 形 成 了 抓 取 系 统 的 一 个 基本 分 类 ， 其 


意 到 这 些 解释 说 明 在 动态 和 准 静态 的 过 程 中 均 


适 3o 


TER 28.5 中 给 出 定义 。 假 设 式 (28.21) 的 解 存在 ， 
则 如 下 的 力 和 速度 方程 提供 了 对 于 多 重 零 空 间 物 理 含 
义 的 深入 理解 ; 
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q-J'v,*N(J)a (28.24) 

v=(G')*v, +N(G')B (28. 25) 

A= -G*g+N(G)y (28. 26) 
Az(J)'t«N(P)« (28. 27) 


在 这 些 等 式 中 ,4 RMB AT XS (此 后 的 伪 
wi); NA) 表示 了 一 个 它 的 矩阵 列 形成 了 N(4) 的 
基 ; a, B, y flm 为 参数 化 解 集 的 任意 向 量 。 其 中 
如 果 没 有 特别 说 明 ， 上 下 文中 会 说 明 广 义 逆 矩阵 是 左 
逆 的 还 是 右 逆 的 。 


表 28.5 基本 抓 取 类 别 
条 dq 分 类 多 对 一 
N(J) #0 元 余 型 4v. 
Ta 
vv, 
N(G') #0 不 确定 型 
ga 
Ag 
N(G) #0 可 抓 取 型 
Veoh 
A—T 
N(J') #0 缺陷 型 : 
Veo? | 
如 果 方 程 中 的 零 空间 是 非 平凡 的 ， 即 可 马上 查看 
在 表 28.5 中 的 第 一 个 多 对 一 映射 。 要 想 了 解 其 他 的 


多 对 一 映射 ， 尤 其 是 缺陷 类 ， 参 考 式 (28.24)。 它 
可 以 通过 将 vv 依次 分 解 为 R(J) SINCE) 中 的 ww 
和 yi 分 量 来 重 写 ， 如 下 所 示 
q =J* (vuv) +N(Da (28.28) 

N(A') 中 的 每 一 个 向 量 都 正 交 于 4 7 的 每 个 行 
Hæ, PK, Jve =0。 如 果 在 式 (28.28) 中 的 æ 
和 办 是 固定 不 变 的 ,那么 4 是 唯一 存在 的 。 由 此 可 
UWAS, WRN) 是 非 平 凡 的 ， 那么 在 接触 
FP 手 转动 的 子 空间 将 会 映射 到 一 个 单一 的 关节 速度 向 
。 将 此 方法 应 用 到 其 他 三 个 等 式 (28.25-28.27), 
则 生成 了 其 他 的 多 对 一 映射 ， 列 于 表 28.5 中 。 

等 式 (28.21) 和 式 (28.24-28.27) 产生 了 下 
列 定义 。 

定义 28.1 宛 余 型 

如 果 N(J) 是 非 平 凡 的 ， 则 称 抓 取 系 统 为 元 
余 型 。 


ENJ) 中 的 关节 速度 q 是 指 手 内 速度 ， 是 因 
为 它们 与 手指 运动 相 一 致 ,但 是 它们 不 在 接触 点 的 


Zr 


[zn 


定义 28.2 不 确定 型 

如 果 N(G') 是 非 平 凡 的 ， 则 称 抓 取 系统 为 不 
确定 型 。 

WIRE NCG) 中 的 转动 v 叫做 物体 内 部 转动 ， 
是 因为 它们 与 物体 的 运动 相 一 致 ， 但 是 不 会 在 接触 中 
约束 方向 上 引起 物体 的 运动 。 如 果 采 用 静态 模型 ， 可 
以 显示 这 些 转 动 不 能 被 手指 的 动作 所 控制 。 

定义 28.3 可 抓 取 型 

如 果 N(G) 是 非 平凡 的 ， 那么 一 个 抓 取 系 统 
就 是 可 抓 取 的 。 

EN(G) 中 的 扭转 强度 A 是 指 物体 内 力 。 这 些 
扭转 向 量 是 内 部 作用 ， 因 为 它们 并 不 影响 物体 的 加 速 
度 ， 例 如 ，GA =0。 反 之 ,这些 扭转 强度 影响 着 抓 取 
的 牢固 性 。 因 此 ， 在 依赖 于 摩 掠 的 持续 抓 取 中 ， 内 部 
扭转 强度 扮演 了 一 个 重要 的 角色 (28.5.2 1), 

定义 28.4 缺陷 型 

WEN) 是 非 平 凡 的 ， 则 称 抓 取 系统 为 缺 


陷 型 。 


ENJ”) 中 的 扭转 强度 A 称 为 手 的 内 力 。 这 些 
力 并 不 影响 式 (28.20) 给 出 的 手 关 节 运 动 学 。 如 果 
考虑 静态 模型 ， 可 以 很 容易 地 显示 从 属于 N() 的 
扭转 强度 不 能 通过 关节 运动 产生 ,但 是 可 以 被 手 的 结 
构 限 制 。 

参见 “ 例 1 第 四 部 分 ”; 
“ 例 3 第 三 部 分 ”。 


28.3.2 刚体 假设 的 限制 


刚体 的 动力 学 等 式 (28.20) 可 以 将 与 接触 约束 
相关 联 的 拉 格 朗 日 乘 子 改写 为 如 下 形式 


“ 例 2 第 二 部 分 ”以 及 


4 T- bna 
MP |=| V-ba; (28. 29) 
A b, 
式 中 , b, = [9(J4)/9q4]4 - [9(Gv)/9u ]u 
M 0 J’ 
M,,=| 0 My -G 
J -G 0 


为 了 用 该 方程 完全 决定 系统 运动 ， 和 矩阵 Mi,, 就 必须 为 
可 逆 的 。 这 种 情况 在 参考 文献 [28.15] 中 被 详细 考 
虑 ， 其 中 多 触 点 操作 的 动力 学 是 在 机 械 手 雅 可 比 矩 阵 


约束 方向 上 产生 手 的 运动 。 如 果 采 用 准 静态 模型 ， 可 
以 显示 出 物体 的 运动 不 受 这 些 动作 的 影响 ， 反 之 


满 行 秩 ， 并 且 是 在 NCJ) =0 的 假设 下 进行 研究 的 。 
XT BUS BU n] ERR E Mi,, 的 操作 系统 来 说 ， 刚 体 动 
力学 就 不 能 决定 动作 和 扭转 的 强度 向 量 了 。 通 过 观察 : 
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N(M,,,) 21(q4 , vA)*lq =0,» =0, 
AeEN(J') AN(G)| 
同 理 ， 在 式 (28.21) 和 式 (28.23) 定义 的 准 静 态 
的 条 件 下 应 用 。 当 N(JD) AN(G) 0 时， 刚体 的 方 
法 不 能 求解 出 式 (28.21) 中 的 第 一 项 ， 因 此 造成 了 
A 的 不 确定 。 

定义 28.5 超 静 定型 

WAR N(J')nN(G) 是 非 平 凡 的 ， 则 称 抓 取 
系统 为 超 静 定型 。 

XE WAR PAREN") 的 内 力 (定义 
28.3) ， 如 缺陷 型 抓 取 中 所 讨论 的 那样 是 不 可 控 的 。 
刚体 的 动力 学 并 不 满足 超 静 定 抓 取 ， 因 为 刚体 的 假设 
导致 了 接触 扭转 的 不 确定 。 参 见 例 3 第 三 部 分 


28.3.3 理想 特性 


对 于 一 个 通用 抓 取 系统 ， 有 三 个 主要 的 理想 特 
TE. 对 物体 转动 » 的 控制 ， 对 于 物体 扭转 g 的 控制 ， 
和 对 于 内 力 的 控制 。 对 于 这 些 量 的 控制 意味 着 机 械 手 
可 以 通过 对 关节 速度 和 动作 的 适当 选择 ， 在 指定 的 
持 力 下 实现 期 户 的 v Ag, 在 J 和 G 中 的 情况 等 同 了 
在 表 28. 6 中 给 出 的 这 些 性 质 。 


表 28.6 抓 取 的 理想 特性 


rh 


任务 要 求 必要 条件 
所 有 扭转 均 可 能 实现 ， g G 的 秩 =n, 
所 有 转动 可 能 实现 , v 
控制 所 有 扭转 ，g I 
控制 所 有 转动 ，v GJ WRK =n, 
控制 所 有 内 力 N(G)nN(J') =0 


我 们 通过 两 个 步骤 便 可 得 出 这 个 关联 的 情况 。 第 
一 步 ， 我 们 忽略 “ 手 ”( 在 了 中 描绘 的 ) 的 结构 和 构 
型 ， 通 过 假设 在 手指 上 的 接触 点 可 以 被 命令 移动 到 任 
何 通过 选择 接触 类 型 而 传递 到 的 方向 。 这 里 一 个 重要 
的 观点 是 被 看 做 是 一 个 独立 输入 变量 ， 并 且 "被 
视 为 输出 量 。 另 一 个 解释 为 驱动 器 可 以 在 约束 方向 上 
产生 任何 的 接触 力 和 力矩 。 类 似 的 ，A 被 视 为 输入 量 
而 g 被 视 为 输出 量 。 在 这 个 假设 下 ,初步 有 利 特性 
为 : 在 物体 (在 G 中 描述 过 ) 上 接触 点 的 布置 和 类 
型 无 论 是 否 如 此 ， 这 个 足够 灵巧 的 手 都 可 以 控制 它 的 
手指 来 指令 任何 属于 R" 的 转动 "»， 并 且 同 样 ， 去 施 
加 任何 属于 R“* 的 扭转 到 物体 上 。 

1. 所 有 物体 转动 是 可 能 区 

给 定 一 组 接触 的 坐标 和 类 型 ， 通 过 计算 式 


(28.19) 中 的 ”或 是 观察 在 表 28.3 右 侧 的 映射 G， 
可 以 看 到 可 行 的 物体 转动 是 那些 在 R(G) 中 的 。 在 
N(G^) 中 的 则 不 能 由 手 通 过 任何 给 定 的 抓 取 而 达 
到 。 因 此 ， 要 想 实 现任 何 物体 的 转动 ， 我 们 必须 有 : 
N(G') =0, 或 者 是 同等 的 ， 和 矩阵 G 的 秩 =n,。 任 何 
有 三 个 非 共 线 的 硬 接触 或 者 是 有 两 个 截然 不 同 的 软 接 
和 触 的 抓 取 都 要 满足 这 个 情况 。 

2. 所 有 物体 扭转 均 可 能 实现 

这 个 状况 是 上 述 情况 的 对 偶 ， 所 以 我 们 希望 是 同 
样 的 条 件 。 从 式 (28.21) 中 ， 会 立即 得 到 N(G7) = 
0 的 情况 ， 所 以 我 们 又 得 到 和 矩阵 G 的 秩 =n。 

要 想得到 以 上 各 种 有 利 变量 所 需 的 条 件 ， 手 的 结 
构 不 能 被 忽略 。 回 忆 得 到 只 有 在 手 上 的 可 实现 的 接触 
扭转 才 会 属于 RJ), MRJ) 不 一 定 等 同 于 R '。 

3. 控制 所 有 物体 转动 

通过 计算 出 式 (28.17) 中 的 v, 可 以 看 到 ， 通 
过 选择 关节 速度 qo 要 想 引 起 物体 的 转动 x， 我 们 必须 
有 R(GJ) 和 N(G' )。 这 些 情况 等 同 于 矩阵 GJ 的 秩 = 
G 的 秩 =n, 

4. 控制 所 有 物体 扭转 

这 个 性 质 与 上 一 个 是 成 对 偶 关 系 的 。 对 于 式 
(28.21) 的 分 析 表 明了 同样 的 情况 : 和 矩阵 GJ 的 秩 = 
G 的 秩 =n,0 

5. 控制 所 有 内 力 

式 (28.20) 表明 了 没有 影响 物体 运动 的 扭转 强 
度 只 出 现在 N(G) 中 。 大 体 而 言 ， 并 不 是 所 有 的 内 
力 都 可 以 通过 关节 运动 被 主动 控制 的 。 在 参考 文献 
[28.12, 17] 中 已 经 表明 了 所 有 在 N(G) 中 的 内 力 
都 是 可 控 的 ， 当 且 仅 当 N(G) 路 N( 了 了 ) =0 时 。 参见 
“ 例 1 第 五 部 分 ”以 及 “ 例 2 第 三 部 分 ”。 

6. 设计 索 尔 兹 伯 里 手 的 注意 事项 

图 28.4 中 的 索 尔 兹 伯 里 手 被 设计 用 最 少 的 关节 


图 28.4 


索 尔 兹 伯 里 (Salisbury ) = 
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数量 来 满足 表 28.6 的 任务 要 求 。 假 设 为 HF 接触 类 
型 , 三 个 非 共 线 的 接触 是 最 小 值 ， 即 G 的 
秩 =n, =6。 在 这 样 的 情况 下 ,矩阵 G 有 6 行 和 9 
列 并 且 N(G) 的 维 数 为 35 所: 。 控 制 所 有 内 力 并 
且 施 加 一 个 任意 的 扭转 到 物体 上 的 能 力 需 要 满足 
N(G)ON(J") =0， 所 以 了 的 列 空间 的 维 数 的 最 
小 值 是 9。 为 了 达到 这 个 条 件 ， 手 必须 要 有 至 少 9 
个 关节 ， 而 索 尔 效 伯 里 手 采用 三 个 手指 ， 每 个 手 
指 都 有 三 个 旋转 关节 。 

用 索 尔 效 伯 里 手 执行 一 个 敏捷 操作 任务 的 方式 为 
在 三 个 非 共 线 的 点 上 抓 住 这 个 物体 ， 形 成 一 个 抓 取 三 
角 。 为 了 确保 抓 住 ， 内 力 被 用 来 控制 使 接触 点 保持 没 
有 滑 移 的 状态 。 灵 人 敏 操作 是 通过 移动 手指 尖 来 控制 抓 
取 三 角形 顶点 位 置 。 


28.4 约束 分 析 


在 抓 取 和 灵巧 操作 中 最 基本 的 要 求 是 使 物体 保持 
平衡 状态 并 且 控 制 其 与 被 控制 的 物体 和 手掌 相对 的 位 
置 与 方向 的 能 力 。 抓 取 约 束 的 两 个 最 实用 的 特性 为 力 
封闭 和 形 封 闭 。 这 些 名 字 在 125 年 前 就 已 经 在 机 械 设 
计 领 域 使 用 了 ， 来 区 分 那些 需要 外 力 保 持 接触 的 关 
节 ， 和 那些 不 需要 的 。 例 如 ,一些 水 轮 内 有 圆 
柱 轴 ,， 被 安置 在 水 平 的 半圆 柱 槽 内 在 轮子 的 两 边 分 
开 ， 在 操作 过 程 中 ， 轮 子 的 重量 使 得 与 槽 轴 的 接触 闭 
合 ， 于 是 就 有 力 闭 合 了 。 通 过 比较 发 现 ， 如 果 槽 被 仅 
仪 是 能 满足 轴 长 的 圆柱 形 的 洞 所 替代 ， 那 么 接触 将 会 
通过 几何 结构 而 停止 (尽管 重力 的 方向 是 颠倒 的 )， 
于 是 就 有 形 封 闭 了 。 

当 将 其 施加 到 抓 取 上 时 ， 力 封 闭 和 形 封闭 有 
如 下 的 解释 。 假 设 一 只 抓 住 一 个 物体 的 手 ， 它 的 
关节 角 是 锁定 的 并 且 它 的 手掌 在 空间 中 国定 ; 如 
果 移 动物 体 是 不 可 能 的 ， 甚 至 是 极 小 的 ， 那么 这 
个 抓 取 就 是 形 封 闭 的 ,或 者 说 这 个 物体 是 闭 形 的 。 
在 同样 的 情况 下 ， 如 果 对 于 任何 非 接 触 的 扭转 强 
度 的 存在 满足 式 (28.20) 并 且 与 通过 摩擦 模型 在 
适合 的 接触 点 施加 的 约束 一 致 ， 则 抓 取 是 力 封闭 
的 ， 或 者 说 这 个 物体 是 力 闭 的 。 注 意 到 所 有 的 形 
封闭 抓 取 也 是 力 封闭 抓 取 。 当 在 形 封闭 的 情况 下 ， 
物体 一 点 都 不 能 移动 ， 此 时 忽略 非 接触 的 扭转 。 
因此 ， 手 保持 着 物体 在 任何 外 加 扭转 下 的 平衡 ， 
这 是 力 封闭 的 要 求 。 

大 体 而 言 ， 当 手掌 和 手指 包 囊 着 物体 时 形成 了 没 
有 余地 的 笼 形 ， 就 像 图 28.5 中 表示 的 抓 取 ， 这 就 是 
FESTA], SIMI A BERK FESR J MP) 或 是 包 络 


抓 取 生 2 。 然 而 ， 力 封闭 在 更 少 的 接触 下 也 是 可 能 
的 ， 就 像 在 图 28.6 中 表示 的 那样 ， 但 是 在 这 样 的 状 
况 下 ， 力 封闭 需要 能 够 控制 内 力 的 能 力 。 对 于 一 个 部 
分 形 封闭 的 抓 取 ， 这 也 是 可 能 的 ， 这 表明 只 有 可 能 的 
自由 度 的 子 集 才 会 被 形 封闭 所 约束 天 2 1。 这 样 的 抓 
取 的 例子 如 图 28.7 Pros, fex UB, TECH TH] 
油箱 盖 的 外 围 对 于 手指 尖 的 放置 提供 了 这 样 的 形 封 
闭 ， 它 反 向 于 关于 螺旋 线 轴 的 相对 旋转 并 且 也 反 向 于 
垂直 轴线 的 平移 ， 但 是 其 他 3 个 自由 度 是 通过 力 封 闭 
来 约束 的 。 严 格 来 讲 ， 通 过 人 的 手 来 提供 一 个 真实 物 
体 的 抓 取 的 时 候 ， 阻 止 物 体 的 关于 手掌 对 于 手 和 物体 
的 服从 的 相对 运动 是 不 可 能 的 。 只 有 当 接 触 体 为 刚性 
时 才 会 阻止 所 有 的 运动 ， 就 像 在 大 多 的 数学 模型 中 应 
用 于 抓 取 分 析 中 的 假设 一 样 。 


图 28.5 手掌 、 手指、 手腕 和 手表 带 相 结合 
构成 一 个 对 电视 遥控 器 非常 牢固 的 形 封 闭 抓 取 


RES 
图 28.6 该 抓 取 具有 适用 于 灵巧 操作 的 力 封闭 抓 取 
(图 片 : shadow 灵巧 手 OShadow 机 器 人 公司 2008) 
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图 28.7 ÉIRE B, TETUB AS 5 BY DUREE ER 
就 产生 了 局 部 的 形 封 闭 ， 这 是 在 盖子 旋转 的 方向 上 (CS 
将 它 拧 紧 的 时 候 ) 并 且 也 在 与 旋转 轴线 垂直 的 平移 方向 
上 。 为 了 达到 对 盖子 的 完全 控制 ， 在 其 他 3 个 自由 度 下 
抓 取 达 到 了 力 封闭 


28.4.1 形 封 闭 


为 了 使 形 封闭 的 概念 精确 ， 引 入 一 个 间隙 函数 ， 
将 物体 和 手 的 每 个 到 接触 点 用 内 (u, q4) 表示 。 这 
个 间 院 函数 在 每 个 接触 中 为 零 ， 如 果 接 触 停止 就 为 
正 ， 并 且 如 果 发 生 贯穿 就 为 负 。 这 个 间隙 函数 可 以 被 
认为 在 接触 点 间 的 距离 。 总 之 ， 这 个 函数 是 独立 的 ， 
它 与 接触 体 的 形状 无 关 。 让 xz 和 4 代表 给 定 抓 取 物 体 
和 和 手 的 结构 ; ABA: 

y(u, q)=0 Vi=1, =, n, (28.30) 

形 封闭 的 状况 现在 可 以 从 的 微分 du 的 变化 方面 来 
描述 了 。 

定义 28.6 

一 个 抓 取 (u, q) 是 形 封闭 当 且 仅 当 满足 如 
下 含义 : 


w(ut+du, q) 20>du =0 (28. 31) 

SU, y 是 间隙 函数 的 n. 维 的 向 量 ， 其 中 的 第 i 个 
坐标 分 量 等 于 y,(u,，g)。 通 过 定义 ， 向量 间 的 不 
等 式 说 明了 不 等 式 被 用 于 向 量 的 对 应 分 量 上 。 

在 关于 妈 的 泰勒 级 数 上 将 间隙 函数 展开 生成 无 穷 
小 的 各 阶 的 形 封闭 。 使 Sy (wu, q), B=1, 2, 3,… 
使 泰勒 级 数 在 du 的 6 阶 之 后 近似 缩短 。 从 式 (28.30) 
中 可 知 ， 它 沿 着 第 一 阶 的 近似 为 

VG + dug) = EOD | dy 


uq) 


SUH, apu, q)/9u| ag RI T TE (u, q) 点 关 
于 的 偏 导数 。 用 在 式 (28.31) 中 的 B 阶 的 近似 值 
THX y UL] T 55 B 阶 相关 的 三 种 情况 : 

1) 如 果 存 在 du 使 sp (二 +du，9) 至 少 有 一 个 绝 
对 为 负 的 分 量 ， 那 么 抓 取 为 关于 忆 阶 的 形 封闭 。 


2) 如 果 对 于 每 个 非 零 的 du ， 式 人 pr(z+duz，9) 
至 少 有 一 个 绝对 为 负 的 分 量 ， 那么 抓 取 为 关于 6 阶 的 
形 封闭 。 

3) 如 果 对 于 所 有 的 "ww(u+du, q) Vasp, fi 
况 1) 和 2) 都 不 适用 ， 那么 则 需要 对 于 高 阶 的 分 析 
来 决定 形 封 闭 的 存在 。 

图 28. 8 用 对 灰色 物体 的 几 个 平面 抓 取 说 明了 形 
封闭 的 概念 ， 抓 取 是 通过 手指 完成 的 ， 在 图 中 用 深 色 
圆 盘 表 示 。 对 于 三 维 物体 的 抓 取 ， 概 念 是 相同 的 ， 但 
是 在 一 个 平面 中 会 更 易 说 明 。 在 左 侧 的 抓 取 是 一 阶 的 
形 封 闭 。 注 意 到 一 阶 形 封 闭 只 包含 距离 函数 的 一 阶 导 
数 。 这 表明 只 有 在 一 阶 形 封闭 中 的 相关 几何 构 型 是 接 
触 的 坐标 和 标准 接触 的 方向 。 在 中 心 的 抓 取 有 更 高 阶 
的 形 封闭 ， 并 且 有 特定 的 阶 ， 它 是 依据 弧度 来 定义 在 
相 邻 接触 中 的 物体 和 手指 的 表面 的 ”1 。 二 阶 形 封 
闭 的 分 析 则 是 依据 两 个 接触 体 的 弯曲 度 并 且 还 有 几何 
的 信息 用 于 分 析 一 阶 的 形 封 闭 。 在 右 侧 的 抓 取 则 是 任 
意 阶 的 形 封闭 ， 因 为 物体 可 以 水 平 翻转 并 且 绕 中 心 
旋转 。 


图 28.8 三 平面 抓 取 : 两 个 具有 不 同 
阶 的 形 封 闭 ， 一 个 没有 形 封闭 


1. 一 阶 形 封闭 
一 阶 形 封 闭会 存在 当日 仅 沼 有 如 下 含义 
| >00 
一 阶 形 封闭 的 情况 可 以 写成 用 物体 的 转动 v 表达 的 
形式 
G'v=0—0 (28. 32) 

RP, G! = ðy/ðuV e R "5, AW TR] D eR c 
确定 距离 的 量 ， 所 以 乘积 Giv 是 在 接触 点 的 物 
体 的 瞬时 速度 的 法 向 分 量 的 向 量 (其 中 接触 点 
必须 是 非 负 的 以 防止 相互 贯穿 透 ) 。 这 反而 表 
明 抓 取 和 矩阵 是 从 所 有 接触 都 是 类 型 PwoF 的 假设 
中 产生 的 。 

一 种 从 属于 RR 的 接触 扭转 强度 的 向 量 和 ,的 等 价 
情况 可 以 叙述 如 下 。 一 个 抓 取 有 一 阶 的 形 封闭 当 且 
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仅 当 : 
G,A, = -g 


VgeR^ 28. 33 
ie que aa 


刚体 形 封闭 ， 必 须 至 少 要 有 n, + 1 个 接触 下 (这 
是 根据 Goldman 和 Tucker1956 年 的 参考 文献 
[28. 25] ) ， 见 表 28.7。 这 引导 我 们 进行 部 分 形 封 闭 


这 种 状况 的 物理 解释 为 在 接触 无 摩擦 的 假设 下 平衡 可 
以 被 保持 。 注 意 到 A, 的 坐标 分 量 是 接触 力 法 向 分 量 
的 数量 级 。 下 标 n 是 用 来 强调 A, 不 包含 其 他 的 力 或 
JENE, 
因为 g 必须 在 G 的 范围 里 为 了 满足 平衡 ， 并 且 
因为 g FER “的 任意 元 素 ， 所 以 为 了 满足 式 (28.33) 
条 件 ，G, 的 秩 必 须 为 6。 假 设 G 的 秩 为 6， 另 一 个 等 
价 一 阶 形 封闭 的 数学 描述 是 存在 A, 满足 如 下 的 两 个 
条 件 使 得 参考 文献 [28.23] 成 立 
G,A, =0 
A, >0 
这 就 意味 着 存在 着 一 组 在 G, 的 零 空 间 中 的 严格 量 
化 正 向 接触 力 。 换 句 话 说 ， 可 以 在 保持 平衡 点 的 
同时 像 期 望 的 那样 紧密 地 挤 压 物体 。 关 于 这 个 状 
况 的 第 二 个 解释 为 非 负 的 跨 列 G, 必 须 等 于 R"。 正 
如 我 们 将 会 看 到 的 ， 这 个 解释 将 会 提供 概念 性 的 
联系 称 作 摩擦 性 形 闭 合 ， 它 存在 于 形 闭 合 与 力 闭 
合 之 间 。 
情况 式 (28.32) 和 式 (28.33) 的 二 重 性 可 以 
通过 检测 扭转 的 设置 来 清楚 地 看 到 ， 这 个 扭转 可 以 通 
过 无 摩擦 接触 和 对 可 能 的 物体 转动 的 相应 设置 来 应 用 
并 施加 。 关 于 这 样 的 讨论 对 于 圆锥 和 它们 的 对 偶 的 定 
义 是 很 有 用 的 。 
定义 28.7 
一 个 圆锥 c 为 一 组 向 量 5， 对 于 在 C 中 的 每 个 
£, & T AEfR BI £ 的 标量 倍数 也 在 C 中 。 
相等 的 ， 一 个 圆锥 为 在 加 法 和 非 负 标量 乘法 作 
下 封闭 的 一 个 向 量 集合 。 


(28.34) 


XE X. 28. 8 

给 定 一 个 含有 元 素 < 的 圆锥 C， 含 有 元 素 4 
的 对 偶 圆 锥 C* 是 一 组 向 量 ， 其 中 4 和 CC 中 的 每 个 
向 量 的 点 积 均 为 非 负 。 


数学 表达 为 : 
C ee Z7 20, Veet 33) 
参见 例 4。 
2. 一 阶 的 形 封闭 要 求 
已 知 几 个 形 封闭 有 用 的 必要 条 件 。 在 1897 年 ， 


Somov 证 明了 ， 要 使 一 个 有 6 个 自由 度 的 刚体 形 封 
闭 ， 必 须 至 少 要 有 7 个 接触 名 2 。 Lakshinarayana 总 
结 了 这 个 要 求 并 且 证 明了 要 使 一 个 有 个 自由 度 的 


的 定义 ， 这 是 在 对 手 抓 取 油箱 盖 的 讨论 中 提 及 过 的 。 
Markenscoff 和 Papadimitriou EX T ZEF, KHK HE 
没有 旋转 的 物体 ， 最 多 有 n, +1 个 接触 是 必需 
的 ”1。 旋 转 表面 是 不 可 能 达到 形 封闭 的 。 
表 28.7 自由 度 为 n, 的 物体 达到 形 
封闭 所 需 的 最 小 接触 数量 n 


3 (平面 抓 取 ) 4 
6 (ZEI) 7 
n, (一 般 抓 取 ) n, +1 


要 强调 n, + 1 个 接触 为 必需 的 并 且 是 不 充足 的 ， 
我 们 就 要 考虑 用 7 个 或 更 多 的 接触 点 来 抓 握 一 个 立方 
体 。 如 果 所 有 的 接触 在 一 个 面 上 ， 那 么 很 明显 这 个 立 
方 体 就 不 是 形 闭合 的 。 

3. 一 阶 形 封闭 的 测定 

因为 形 封闭 的 抓 取 是 很 精确 的 ， 所 以 设计 或 是 合 
成 这 样 的 抓 取 是 可 取 的 。 为 此 ， 需 要 一 种 方法 去 测试 
对 于 形 封闭 候选 的 抓 取 ， 并 且 将 它们 排序 以 选 出 最 佳 
抓 取 。 一 个 合理 的 形 封闭 的 测量 可 以 由 此 状况 的 解析 
几何 得 出 式 (28. 34)。 零 空间 约束 入 A, 的 正 值 性 条 
件 代 表 了 通过 AA, 的 分 量 进行 缩放 的 G, 空 间 的 加 和 。 
任何 可 以 关闭 循环 的 关于 和 的 选择 都 在 N(G,) Po 
对 于 一 个 给 定 的 循环 ， 若 人, 最 小 分 量 的 大 小 是 正 的 ， 
那么 抓 取 就 是 形 封 闭 的 ， 反 之 亦 然 。 我 们 用 d 表示 该 
最 小 分 量 。 因 为 这 样 一 个 循环 ， 于 是 d 可 以 被 任意 缩 
放 ， 为 了 计算 方便 ，A, 应 该 为 有 界 。 

当 确 定 G, 为 行 满 秩 ， 一 个 基于 以 上 观察 结果 的 
定量 形 封闭 的 测定 可 以 形成 一 个 关于 未 知 的 gd 和 A, 
的 线性 规划 (LP) ， 形 式 如 下 


LPL; 最 大 值 :4 (28.36) 
受 的 约束 : G,A,-0 (28.37) 
IA, - ldz0 (28.38) 
d=0 (28. 39) 

l'A, <n, (28. 40) 


AP, Ie RU" EARME EH. Te R "ee 
各 元 素 都 为 1 的 矢量 。 最 后 一 个 不 等 式 的 目的 是 为 了 
防止 这 个 线性 规划 最 后 变 得 不 可 控制 。 一 个 典型 的 
LP 的 求解 方法 决定 了 约束 的 不 可 行 性 或 无 界 性 ， 这 
些 约 束 属 于 所 谓 的 算法 第 一 阶段 ; 并 且 在 尝试 计算 最 
优 值 之 前 先 考 虑 一 下 结果 '*”1。 如 果 LP1 是 不 可 行 
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的 ， 或 者 如 果 这 个 最 优 值 4* 为 0， 那 么 该 抓 取 就 不 
是 形 封闭 的 。 

这 种 定量 的 “ 形 封闭 ”测定 ( 式 (28.36) -X 
(28.40)) An, +8 个 约束 和 n+1 个 未 知 数 。 就 一 
个 典型 的 n, <10 的 抓 取 ， 这 是 个 能 用 单一 方法 很 快 
算出 来 的 小 型 “线性 规划 ”。 但 是 我 们 必须 注意 ， 度 
tt d 取决 于 形成 G, 时 对 单元 n (数量 ) 的 选择 。 所 
以 ， 对 上 述 不 佳 情况 作 适 当代 换 以 避免 “4d 取决 于 其 
单位 数量 ”的 问题 。 这 可 以 用 “特征 力 ” 分 开 G 的 
前 三 列 ， 用 “特征 力矩 ”分 开 G 的 后 三 列 来 实现 。 

然而 ， 如 果 和 希望 进行 二 进 制 测定 ，LP1 可 以 通过 
去 掉 最 后 的 约束 式 (28. 40)， 只 运用 单纯 形 运算 的 
第 一 阶段 而 被 转换 为 二 进 制 。 

总 之 ,“ 形 封闭 ”的 测定 有 两 个 步骤 。 

4. 形 封 闭 测 定 

(1) 计算 秩 (Gn) 

1) 如 果 秩 (Gn) z n,, 那么 形 封 闭 不 存在 。 
结束 。 

2) MARR (Gn) =n,, ME, 

(2) 求解 LP1 

1) 如 果 d”=0， 那 么 形 封闭 并 不 存在 。 

2) 如 果 d”>0， 那么 形 封闭 存在 并 且 d* 是 衡量 
这 个 控制 脱离 形 封闭 的 程度 的 粗略 的 标准 。 

5. 测定 的 变化 

如 果 秩 的 测定 失败 了 ， 这 个 抓 取 就 会 有 部 分 的 
“ 形 封 闭 ” 还 余下 与 秩 (G,) 一 样 多 的 自由 度 。 如 果 
想 对 其 进行 测定 ， 必 须 用 一 个 新 的 G,， 保留 与 将 要 
测定 的 部 分 形 封闭 的 自由 度 相同 数量 的 列 ， 从 而 解决 
这 个 LP1。 如 果 d* >0， 那么 局 部 形 封 闭 就 存在 。 第 
二 种 变化 是 约束 d 的 值 ， 使 其 比 一 些 大 的 负 值 更 大 。 
如 果 这 样 做 ,那么 4”<0 就 成 了 一 个 抓 取 达到 “ 姑 
封闭 ”的 程度 的 粗略 估计 。 见 例 5。 

6. 平面 简化 

在 平面 情况 下 ，Nguyenls3l 发 明了 一 种 图 示 的 
定性 测定 “ 形 封 闭 ” 的 方法 。 图 28.9 显示 了 两 种 有 
四 个 触 点 的 形 封闭 的 抓 取 。 为 了 测定 “ 形 封 闭 ”， 我 
们 将 其 分 配 到 两 个 小 组 中 。C, 和 C, 分 别 为 这 两 组 中 
两 个 常数 的 正极 差 。 有 “ 形 封 闭 ” 的 抓 取 ， 需 要 当 
且 仅 当 C, CG 或 者 -C,，-C, 是 相互 呼应 的 。 两 个 
圆锥 体 相互 呼应 是 指 ， 由 顶点 分 别 发 出 的 两 条 分 割 线 
同时 经 过 两 个 圆锥 。 产 生 超过 4 个 交点 ， 如 果 产 生 任 
意 的 一 个 交点 满足 条 件 ， 这 个 抓 取 就 是 “ 形 封闭 ”。 
注意 这 种 图 示 法 很 难 应 用 于 超过 4 个 交点 的 情况 。 而 
且 ， 它 无 法 应 用 于 三 维 抓 取 的 情况 ， 也 不 能 提供 一 种 
封闭 的 测量 。 
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图 28.9 具有 一 阶 形 封闭 的 平面 抓 取 


28.4.2 JHA 


当面 对 任何 物体 扭转 时 仍然 可 以 保持 ， 那 么 这 个 
抓 取 就 有 力 封闭 ， 或 者 说 是 力 封闭 型 的 。 力 封闭 与 形 
封闭 相似 ,但 是 对 于 可 以 帮助 平衡 物体 外 力 的 座 擦 力 
却 没 有 很 多 的 限制 。 在 分 析 中 考虑 摩擦 力 的 好 处 是 可 
以 减少 封闭 必需 的 接触 点 的 数目 。 有 6 个 自由 度 的 三 
维 物 体 需要 7 个 接触 点 来 实现 形 封闭 ， 但 是 对 于 力 封 
闭 ， 如 果 是 软 手指 模型 ， 只 需要 两 个 接触 点 ， 如 果 是 
硬 手 指 模型 只 需要 3 个 接触 点 (不 共 线 ) 。 

力 封 闭 依赖 于 机 械 手 任意 地 紧 紧 抓 住 物体 的 能 
力 ， 这 是 为 了 补偿 大 量 实际 的 只 能 被 摩擦 力 所 平 衡 的 
扭转 向 量 。 图 28. 14 所 示 是 一 个 被 抓 取 的 多 边 形 ( 见 
例 2) 。 当 我 们 把 一 个 与 惯性 坐标 系 的 y 轴 平 行 且 向 
上 的 纯 轴 向 力 的 扭转 施加 在 一 个 物体 上 时 ， 直 觉 上 好 
像 是 如 果 有 足够 大 的 摩擦 力 ， 机 械 手 能 够 利用 摩擦 力 
抓 住 物体 阻止 其 向 上 运动 。 同 样 ， 当 施加 的 力 幅度 增 
加 时 ， 抓 取 力 的 幅度 也 必须 相应 地 增加 。 

由 于 力 封闭 依赖 于 摩擦 的 模型 ， 在 正式 介绍 力 封 
闭 的 定义 之 前 会 先 介绍 一 般 的 模型 。 

1. 摩擦 模型 

回忆 前 面 给 出 的 各 种 不 同 接触 模型 中 通过 接触 ; 
传递 的 分 力 与 力矩 ( 见 表 28.4)。 在 接触 点 i， 摩擦 
定律 给 接触 力 及 力矩 的 各 部 件 施加 了 约束 。 特 别 地 ， 
和 ,的 摩擦 分 量 被 约束 在 极限 面 内 ， 表 示 为 /,， 其 与 
Lf, 的 乘积 成 线性 比例 ， 其 中 j, 是 接触 点 i 的 摩擦 系 
数 。 在 静摩擦 的 情况 下 ， 极 限 面 是 一 个 以 jf 为 半 
径 的 圆 。 静 摩擦 锥 .是 R ;的 一 个 子 集 。 

F= $ (Fas fas Fo) | S+ Shi fa} (28.41) 

更 为 一 般 地 ， 摩 擦 定律 在 摩擦 分 量 空间 内 定义 有 
极限 面 ，R“!， 在 入;,，R “内 定义 有 摩擦 锥 .有 7。 他 们 
可 以 写作 


F, =| ER" | |A; llo sf, (28. 42) 

x, lA l 表示 在 接触 点 i 的 摩擦 分 量 加 权 二 次 范 
Be, PARR BRE SOK || A, ll, =f e 

HE 28.8 定义 了 三 种 接触 模型 : PwoF 模型 、HF 

模型 和 SF 模型 的 有 用 的 加 权 二 次 范 数 。 参 数 册 是 切 

向 力 的 摩擦 系数 ，vw 是 扭转 摩擦 系数 ，a 是 物体 的 特 
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征 长 度 ， 用 于 确保 SF 模型 中 的 范 数 项 的 单位 一 致 性 。 


虽然 决定 形 封闭 时 G 
行 满 秩 同样 是 形 封闭 的 条 
仍然 需要 找到 能 够 满足 条 


5 G, 并 不 相同 ,但 矩阵 G 
件 之 一 。 如 果 秩 测定 通过 ， 
余 三 个 条 件 的 A。 通 过 这 


表 28.8 三 种 主要 接触 模型 的 范 数 
模型 || Ai ll, 
PwoF 0 
1 A 
HF "m fi +fio 
1 7— 1 
SF A Vfi tfio uU Min | 


关于 摩擦 锥 有 几 点 需要 注意 。 首 先 ， 所 有 这 些 都 
明确 或 隐 含 地 约束 了 一 般 的 接触 力 法 向 分 力 为 非 负 


些 ， 零 空间 相交 测定 可 以 通过 线性 规划 技术 很 容易 地 
实现 ， 但 是 摩擦 锥 约束 是 二 次 的 ， 这 使 得 我 们 必须 使 
用 非 线性 规划 技术 。 虽 然 准 确 的 非 线性 测定 已 经 开发 
出 来 了 Ia ， 但 这 里 只 展示 近似 测定 。 

3. 力 封闭 近似 测定 

所 有 以 上 讨论 的 摩擦 锥 都 可 以 近似 为 一 个 摩擦 猴 
母线 S UU ERO n, 生成 的 非 负 空间 。 知 道 这 些 以 后 ， 
我 们 就 可 以 将 一 些 在 接触 点 ;适用 的 接触 扭转 集合 表 


值 。SF 接触 类 型 的 锥 具有 圆柱 形 极限 界面 ， 其 在 
Go fo) FERRA RRA, Æ (fa, ma) 平面 内 
HAERERE. FER PRU T rp, FLEE TRE f 
递 不 受 横向 摩擦 载荷 的 制约 。Howe 和 Cutkosky P5? 
研究 了 一 种 耦合 扭转 摩擦 极限 与 切 向 摩擦 极限 的 改进 
模型 3] 。 
2. 力 封闭 的 定义 
关于 力 封闭 的 一 个 常见 的 定义 可 以 简单 表述 为 改 
变 条 件 式 (28.33) 使 得 每 个 接触 力 都 作用 在 它 的 摩 
擦 锥 之 内 而 不 是 作用 在 沿 接触 点 法 线 方向 。 因 为 这 个 
定义 并 没有 考虑 到 机 械 手 能 够 控制 接触 力 的 能 力 ， 这 
种 定义 被 称 为 摩擦 形 封 闭 。 一 个 抓 取 是 摩擦 形 封 闭 
的 ， 当 且 仅 当 下 列 条 件 成 立 : 
GA- -g 
Ae. 
Ath, FRAME, EXN: .=.7; x… xT, = 
\AER"| Ae F,; i=l, …, | ， 并 且 每 个 .到 都 符 
合式 (28.42) 的 定义 ， 其 中 一 种 模型 见 表 28. 8。 
4 mt (F) 表示 复合 摩擦 锥 的 内 部 ，Murray 等 
人 给 出 了 如 下 的 等 价 定义 I* 中 
定义 28.9 
个 抓 取 具有 摩擦 形 封闭 当 且 仅 当 以 下 条 件 
成 立 : 
1) rank (G) =n,, 
2) FA (if GA =0 FF A A eInt (F), 


这 些 条 件 定义 了 Murray 等 人 所 谓 的 力 封 闭 。 这 
里 采用 的 力 封 闭 的 定义 比 摩擦 形 封 闭 更 为 严格 ; 此 
外 ， 它 还 要 求 机 械 手 能 够 控制 物体 的 内 力 。 
定义 28. 10 
一 个 抓 取 具 有 力 封 闭 当 上 且 仅 当 rank(G) =n,, 
N(G) ANJ") 20, 并 且 存 在 入 使 得 GA =0 JH. A 
eln (.F)。 


Wee” 


示 为 
GA,=S,0,, o,=0 

WP, S, = (Sa Sa) 和 是非 负 母线 分 量 的 一 个 
向 量 。 如 果 接 触 了 是 光滑 的 ,那么 mw =1 并 且 5; = 
[n; (C; -P) xn)" ]'. 

如 果 接 触 i 是 HF 型 的 ， 我 们 可 以 将 摩擦 锥 用 一 
些 非 负 的 均匀 间隔 的 接触 力 的 母线 ( 见 图 28.10) 的 
总 和 来 表示 ， 这 些 母 线 生成 的 非 负 空间 近似 于 具有 一 
个 内 切 正 多 边 形 锥 的 库仑 锥 。 这 些 就 引出 了 如 下 关于 
S; 的 定义 


1 


z (=) 
ios M;cos | = 


. (2km 
msin( 77) 
OH, Herk 从 1 变化 到 n,。 如 果 更 偏向 使 用 外 接 多 
边 形 锥 来 近似 二 次 摩擦 锥 ， 只 需要 将 上 述 定义 的 
改 为 /cos( mn, ) 即 可 。 


(28. 43 ) 


Sit 
图 28. 10 近似 为 一 个 七 根 母线 的 多 面体 锥 的 二 次 锥 


对 于 SF 模型 需要 做 出 的 调整 很 简单 。 由 于 在 该 
模型 中 扭转 摩擦 都 是 与 切 向 摩擦 相对 应 的 ， 它 的 母线 
可 以 由 [1 0 0 br] 给 出 。 因 此 SF 模型 的 5, 为 
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1 1 1 
人 LiCOS EJ 0 0 
Si- K 
msin( <] 0 0 
n, 
0 bv; 一 bw， 


(28.44) 
式 中 , 是 统一 单位 的 特征 长 度 。 在 任何 接触 点 都 不 
违反 接触 摩擦 定律 的 可 应 用 于 机 械 手 的 总 接触 扭转 集 
合 可 以 被 写作 


GA=So, o=0 

RP, S=(8,, +, $,) 并 且 w= (ol…ol) 

再 用 对 偶 形式 来 表示 摩擦 约束 非常 方便 : 

F,A,20 (28. 45) 

在 这 种 形式 中 , F, 的 每 一 行 都 正 交 于 由 近似 
锥 的 两 根 相 邻 母线 所 形成 的 面 。 对 于 一 个 HF 接触 
RL, F, 的 行 i 可 以 由 5S, 和 S$,+1 的 向 量 积 所 得 。 
在 SF 接触 的 情况 下 ， 母 线 都 是 四 维 的 ， 因 此 简单 
的 向 量 积 这 里 并 不 能 满足 需求 。 然 而 ， 对 于 能 从 
母线 形式 转换 到 正 交 面 形式 的 一 般 方法 依然 
PES, 

所 有 接触 的 正 交 面 约束 可 以 归纳 为 以 下 的 简洁 
形式 


FA=0 
式 中 , F =Blockdiag(F,, =, F,). 

我 们 让 第 一 行 H, X e; e R', 另外 让 e = 
(e1,…,e,)eR' 并且 让 E = Blockdiag (e,, ©, 
e) e 民 '。 下 面 的 线性 规划 是 一 个 判断 摩擦 是 否 形 
封闭 的 定量 测定 。 最 优 目 标 函 数值 4 ” 是 接触 力 离 它 
们 的 摩擦 锥 边界 的 距离 的 度量 ， 因 此 也 是 一 种 粗略 地 
反映 一 个 抓 取 离 失去 摩擦 形 封 闭 有 多 远 的 一 种 度量 。 

LP2: ”最 大 值 : d 

受 的 约束 : GA=0 

FA-Idz0 
d=0 
eAxn, 

LP2 中 最 后 一 个 不 等 式 是 接触 力 的 垂直 分 量 大 
小 的 简单 相 加 。 解 决 LP2 后 ， 如 果 d” =0, 那么 
摩擦 形 封闭 并 不 存在 ,但 是 如 果 d”>0 那么 确实 
存在 。 

如 果 一 个 控制 是 摩擦 形 封闭 的 ， 那 么 确定 力 封闭 
是 否 存 在 的 最 后 一 步 是 证 实 NCG)mN( 广 ) =0。 如 
果 条 件 符合 ， 那 么 这 个 抓 取 就 是 力 封闭 的 。 该 条 件 很 
容易 用 另 一 个 线性 规划 LP3 验证 。 

LP3: ”最 大 值 : d 


(28. 46) 


受 的 约束 : GA=0 
J'A=0 
EA - Idz0 

dz0 

eAxn, 

4. 近似 力 封闭 测试 

总 之 ， 力 封闭 测试 是 一 个 具有 三 个 步 又 的 过 程 : 

(1) 计算 G 的 秩 

1) 如 果 秩 〈G) 关 m ， 那 么 力 封闭 不 存在 ， 结 束 。 

2) 如 果 秩 (G) =n,, WEE, 

(2) 解 LP2: 测定 是 否 摩擦 形 封 闭 

1) WR d* =0, 那么 摩擦 形 封 闭 不 存在 ,结束 。 

2) WR d* >0, 那么 摩擦 形 封闭 存在 ， 并 且 d* 
是 一 种 反映 抓 取 离 失去 摩擦 形 封 闭 有 多 远 的 一 种 简单 
粗略 的 度量 。 

(3) 解 LP3: 测定 内 力 的 控制 

1) WRd* >0, 那么 力 封闭 并 不 存在 。 

2) 如 果 d”=0， 那 么 力 封闭 存在 。 

见 例 1 第 六 部 分 。 

5. 平面 简单 化 

在 平面 抓 取 系统 中 ， 上 述 近 似 的 方法 是 精确 的 。 
这 是 因为 SF 模型 是 无 意义 的 ， 这 是 因为 接触 法 线 方 
的 旋转 会 造成 平面 外 的 运动 。 至 于 HF 模型 ， 对 于 
平面 问题 来 说 ， 二 次 摩擦 锥 会 变 为 线性 的 ， 并 且 这 个 
锥 可 以 准确 地 表示 为 : 


E 


Fa. L 
F,-— — (28. 47) 
Deu -l 

Nguyen 的 图 解 形 封闭 测定 可 以 应 用 到 有 具有 两 个 
摩擦 接触 的 平面 抓 取 “”。 叭 一 的 变化 是 四 个 接触 
点 法 线 变 为 两 个 摩擦 锥 的 四 条 母线 。 然 而 ， 这 种 测定 
只 能 确定 是 否 具 有 摩擦 形 封 闭 ， 因 为 它 并 不 包含 判断 
是 否 力 封闭 所 需 的 其 余 信息 。 


范例 


28.5 


28.5.1 例 1: 球体 抓 取 


1. 第 一 部 分 : G 和 J 

图 28. 11 显示 了 一 个 由 两 根 机 械 指控 制 的 半径 为 
r 的 三 维 球体 在 平面 的 投影 ， 两 个 接触 角 分 别 为 9, 和 
9,。 两 个 坐标 系 (C) A (Cl, 的 方向 是 确定 的 ， 因 
此 他 们 的 0 方向 指向 图 像 所 示 平 面 外 (如 小 黑 圆 所 
示 ) 。 坐 标 系 [N] 和 (B) 的 坐标 轴 被 选 作 与 坐落 
在 球 心 的 点 相 一 致 的 原点 所 沿 的 轴 。z 轴 指 向 纸 面 


196 第 4 篇 


操作 与 接口 


外 。 注 意 到 这 点 以 后 ， 因 为 左 指 的 两 个 关节 轴 都 垂直 
F (x,y) 平面 ， 它 始终 在 该 平面 内 运动 。 男 外 一 


根 手指 有 三 个 转动 关节 。 因 为 它 的 第 一 和 第 二 轴 ， 忆 
和 Z,， 一 般 都 位 于 平面 内 ， 关 于 Z, 轴 的 旋转 会 使 得 


Z, 轴 获 得 一 个 向 平面 外 的 分 量 而 造成 接触 点 2 处 的 
旨 尖 远离 这 个 平面 。 


图 28.11 带 有 5 个 转动 关节 的 两 指 抓 取 球体 


在 当前 构 型 中 ， 第 ;个 接触 坐标 系 的 旋转 矩阵 可 


以 定义 为 
-cos(0) sin(0,) 0 
区 — cos(6,) | (28. 48 ) 
0 0 1 
给 定 从 [NT 原点 出 发 到 第 ;个 接触 点 的 向 


量 为 


c; -p 2 r(cos(0,) sin( 6,)0)" (28.49) 
tr Ask (28.3) 和 式 (28.6) 得 到 完整 的 接触 
à i BOSTUBOR IHE 


-c s 0 
-s -c, 0 0 
= 0 0 1 
gis 0 0 rs 一 C s 0 


(28. 50) 

RP Oe R?? EPRE; c; RI s; 分 别 为 cos(b)) 

和 sin( 9,) 的 缩写 。 完 整 的 抓 取 和 抢 阵 的 定义 为 : G = 
(G1G,) eR x 

这 个 矩阵 的 准确 性 可 以 由 以 下 检查 验证 :例如 ， 

第 一 列 是 单元 接触 点 法 线 方向 的 单位 扭转 ， 前 三 个 分 


量 是 7, 的 方向 余弦 ， 后 三 个 分 量 是 (c, - p) x n, 的 
FHAR. HFA, 与 (c,-p) 是 共 线 的 ， 因 此 二 者 
的 向 量 积 〈 这 列 的 最 后 三 个 分 量 ) 为 0。 第 二 列 的 最 
后 三 个 分 量 代表 了 7, 关于 坐标 系 INI 的 x-，y-， 
z- 轴 的 力矩 值 。 因 为 了 位 于 (x, y) Fi, 
x, y 轴 的 力矩 值 必然 为 零 。 显 然 7, 产生 了 一 个 关于 
z 轴 的 力矩 ， 值 为 -r。 

建立 接触 ;的 完整 机 械 手 雅克 比 和 矩阵 J, 需要 关 
于 关节 轴 方 向 与 坐标 系 安装 在 各 个 机 械 手指 连 杆 上 的 
坐标 系 原点 的 信息 。 图 28. 12 显示 了 与 图 28. 11 相同 
结构 的 机 械 手 ， 但 具有 一 些 建立 机 械 手 雅克 比 矩 阵 所 
需 的 额外 的 数据 。 假 设 关节 坐标 系 的 原点 位 于 图 所 在 
的 平面 内 。 


图 28.12 机械手 雅克 比 矩 阵 的 相关 数据 


在 现在 的 构 型 中 ， 接 触 点 1 的 相关 参量 可 以 在 
(Ch, 中 表示 为 


c -0=( & 0) (28.51) 
c -= L 0)" (28. 52) 
z,-2,-(0 0 1)" (28. 53) 

接触 点 2 的 相关 参量 在 (CI, 中 表示 为 : 
c, -¢,=¢,-£,=(4, -l 0)" (28.54) 
c,-£,=(1, 0 0)" (28. 55) 
2 =( 0 0)" (28. 56) 
£0) = 2-1 -1 0)" (28.57) 
Z (43.94) =(0 0 1)" (28. 58) 


通常 c -Z 和 z 向 量 的 所 有 分 量 (包括 那些 在 现 
有 构 型 中 为 零 的 分 量 ) 都 是 关于 4 Flu 的 函数 。z 向 
量 的 依赖 性 已 经 十 分 明确 地 显示 出 来 了 。 

代入 式 (28.14), zÈ (28.11) 和 式 (28.8) 得 
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到 完整 的 机 械 手 的 雅克 比 行列 式 Je RS, 
E ns 一 五 -L 
hb h L 4 
0 0 0 0 0 
0 0 
0 0 0 
0 0 J= 0 0 0 0 (28. 60) 
1 1 0 0 ls 
0 0 E 
ia 0 i d F(u +l) 0 
2 
l, EX! L +1) (0) 0 E 0 
0 注意 到 改变 接触 类 型 可 以 通过 移 除 更 多 的 行 来 轻 
0 -2 9 易 实 现 。 把 接触 1 改 为 HF AT AHER G' 和 J 的 
2 第 4 行 来 实现 ， 而 通过 去 除 G 和 J 的 第 2、3、4 行 
a 23 0 可 以 将 接触 1 改 为 PwoF 型 。 改 变 接触 2 的 模型 将 去 
; > | 除 第 8 行 或 者 同时 去 除 第 6、7、8 行 。 


水 平分 割 线 将 了 分 为 J，( 顶 部 ) 5J, (底部 ) 。 
各 列 相应 于 关节 1 -5。 块 对 角 结构 是 机 械 手指 ; DUE 
啊 接 触 ; 这 一 事实 的 结果 。 

2. 第 二 部 分 : G 和 J 

假设 图 28. 11 中 的 接触 都 为 SF 型 的 。 那么 给 定 
EEEH H: 


1 00000 
010000 0 
001000 
H-|000100 
100000 
0 010000 
001000 
000100 


因此 和 矩阵 GT e ROMS RJ e RO dp d Je 


G' fl J 80555. 6, 11 和 12 行 所 构成 的 : 
-s, 0 0 0 o0 


eu 


$1 -cq 0 0 0 -r 
0 0 1 r$, —rs, 

g- 0 0 0 一 cl -Ssi 
-& -s 0 0 0 
$5 -c, 0 0 0 -r 
0 0 1 T$ -reo 0 
0 0 0 =i =% 0 


(28. 59) 


3. 第 三 部 分 : 简化 为 平面 情况 

如 图 28. 11 所 示 的 抓 取 可 以 按 上 述 给 出 的 准确 公 
式 简 化 为 一 个 平面 问题 ， 另 外 ， 当 了 解 了 矩阵 的 不 同 
的 行 和 列 的 物理 意义 后 ， 问 题 也 可 以 被 解决 。 开 始 移 
除 在 平面 外 的 速度 和 力 。 这 可 以 由 移 除 [NI 和 


(B) 的 z 轴 和 接触 点 的 o 的 方向 来 实现 。 此 外 ， 关 
节 3 和 4 必须 是 锁定 的 。G" 和 J 的 结果 由 消除 特定 
的 行 和 列 来 构造 。G” 通过 移 除 第 3、4、7、8 行 和 第 
3、4、5 列 来 形成 。J 通过 移 除 第 3、4、7 、8 行 和 第 
3, 4 列 来 形成 : 


-e -s 0 
- -s -Cc 一 
G = (28.61) 
-c, -s, 0 
A -6 -r 
-l4 -4 0 
l l 0 
J= 7 28. 62 
0 0 0 ( ) 
0 0 k 


4. 第 四 部 分 : 抓 取 分 类 

表 28.9 的 第 一 列 反 映 了 不 同 接触 模型 下 球形 抓 
取 范 例 G 和 的 主要 子 空间 维 数 。 只 有 非 平凡 的 零 
空间 被 列 出 。 

在 两 种 HF 接触 模型 的 情况 中 ， 所 有 四 个 零 空 间 
都 是 非 平凡 的 ， 因 此 该 系统 符合 所 有 四 个 抓 取 类 型 的 
条 件 。 这 个 系统 是 可 抓 取 的 ， 因 为 沿 着 连接 两 个 接触 
点 的 线段 上 分 布 着 内 力 。 通 过 机 械 手 不 能 承受 沿 着 那 
条 线 的 作用 力 抢 这 个 事实 可 以 看 出 不 确定 性 是 显然 
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表 28.9 例 1 中 所 研究 抓 取 的 主要 子 空间 维 数 和 分 类 


模 型 维 数 ES 别 
HF，HF dim WJ) =1 宛 余 型 
dim.4GIT) =1 不 确定 型 
dim W(G) =1 可 抓 取 型 
dim SJ") =2 缺陷 型 
SF, HF dim JJ) =1 宛 余 型 
dim W(G) =1 可 抓 取 型 
dim WJ") =3 缺陷 型 
HF, HF dim M(G) =1 可 抓 取 型 
dim W(J") =2 缺陷 型 
SF, HF dim M(G) =2 可 抓 取 型 
dim WJ") =3 缺陷 型 


的 。 宛 余 是 存在 的 ， 因 为 虽然 关节 3 使 接触 点 2 移 除 
图 示 平 面 ， 但 是 关节 4 可 以 反方 向 旋转 来 取消 这 个 运 
动 。 最 后 ， 这 个 抓 取 是 缺陷 型 的 ， 因 为 沿 着 接触 1 和 
的 o I my 方向 的 接触 力 和 瞬时 速度 ， 各 自 都 不 能 
通过 关节 扭矩 和 速度 来 控制 。 这 些 解 释 在 下 面 的 零 空 
间 的 基本 和 矩阵 中 已 被 证 实 , 用 > =1，cos(0) = 
-0.8 = —cos(6,), sin(6,) =cos(6,) = -0.6, 以 及 
L =0 来 计算 


N 


0 
0 
0 
0 
N(J) =| -0.73 |, N(G") = p 
pu | 0. 86 
0. 69 
0 
0 
0 
(28. 63) 
0. 57 0 0 
-0.42 0 0 
NG-| ^ | wo 7 
057 |’ 1 0 
0. 42 0 0 
0 0 0 
(28. 64) 
注意 到 将 其 中 任 一 接触 改 为 SF 型 都 将 使 机 械 手 
承受 作用 在 沿 着 包含 接触 点 的 直线 上 的 外 力矩 变 为 可 


umb 


k 
EE， 因 此 该 抓 取 失去 了 不 确定 性 ,但 是 保持 了 可 抓 取 
生 〈 沿 着 含 接触 线 的 紧 握 依然 是 可 能 的 ) 。 然 而 ， 如 
接触 点 2 是 SF 型 接触 ， 这 个 抓 取 就 会 失去 了 宛 余 


= 


Nm 


性 。 虽 然 第 二 个 接触 点 依然 可 以 通过 关节 3 来 移出 平 
面 并 且 通 过 关节 4 回 到 平面 内 ， 但 是 这 种 接触 点 的 相 
互 抵消 的 平移 产生 了 一 个 沿 着 郊 的 纯 转 动 (这 也 意 
味 着 机 械 手 可 以 控制 作用 在 沿 着 包含 接触 点 的 线 上 的 
物体 的 力矩 ) 。 接 触 点 2 改 为 SF 型 不 会 影响 机 械 手 不 
能 沿 着 o, 和 nn, 方向 移动 接触 点 1 和 2 的 性 能 特点 ， 
因此 缺陷 型 抓 取 依 然 保持 。 

5. 第 五 部 分 : 理想 特性 

假设 接触 点 1 和 2 的 接触 模型 类 别 分 别 为 SF 型 
和 HF 型 ，G 是 行 满 秩 并 有 旦 因此 N(G") =0 ( 见 表 
28.9) 。 因 此 ， 只 要 机 械 手 足够 灵巧 ， 它 可 以 在 物体 
HIR 中 实现 任何 扭转 。 同 样 ， 如 果 关 节 是 锁定 的 ， 
就 会 阻止 物体 运动 。 假 设 同样 问题 的 值 使 用 这 个 问题 
前 面部 分 的 值 ， 可 以 得 到 矩阵 G" 
-c -s 0 0 0 0 


(28. 65) 


三 个 非 平凡 的 零 空 间 的 基 矩阵 分 别 为 
0 0 0 
0 0 


N(J') = (28. 66) 


ooo c 


N(J) =| -0.73 


N(G)~| 0 (28. 67) 
0. 57 
0. 42 
0 
因为 R(J) 是 四 维 的 , N(G) 是 一 维 的 ， 因 此 
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R(J) +N(G) 的 最 大 维 数 不 可 能 超过 五 ， 因 此 ,机 
械 手 不 能 控制 物体 所 有 的 可 能 速度 ， 举 例 来 说 ,接触 ” 28.5. 2 例 2: 平面 多 边 形 抓 取 
IJE V, = (0000. 8000)" EF NOJ) 之 内 ， 因 此 不 1. 第 一 部 分 : G 和 .J 


能 够 被 机 械 手 指 所 控制 。 同 样 ，G" 第 三 列 的 0.6 fis 
mE G 的 第 四 列 也 在 R(G") 内 。 因 为 R(G) MR 
(G') 的 映射 关系 是 一 一 对 应 映射 的 ， 这 种 不 可 控 的 


图 28. 14 显示 的 是 一 个 平面 机 械 手 抓 取 一 个 多 边 
形 。 右 边 的 机 械 手 指 1 包含 了 两 个 关节 ， 分 别 记 为 1 
和 2。 机 械 手指 2 包含 了 关节 3 ~7， 离 手掌 越 远 ， 编 


接触 速度 和 一 个 唯一 的 不 可 控 的 物体 速度 相 一 致 ， 就 
Æ v = (000. 6100) 。 换 句 话 说， 机械 手 不 能 使 球 心 在 
z 方 向 上 平移 ， 也 不 能 绕 着 x 轴 转 动 (同时 也 不 能 绕 
着 其 他 轴 转 ) 。 

We 
HX NJ") AN(G) =0。 这 论 与 N(G) 
AO E 实 无 关 ， 然 而 N 
CJ") 所 有 列 在 那些 位 置 都 为 零 。 

6. 第 六 部 分 : 力 封闭 

再 次 假设 在 抓 取 球体 上 的 接触 点 1 和 2 分 别 为 
SF 和 HF 接触 类 型 。 在 该 假设 下 ，G 是 行 满 秩 的 ， 并 
且 内 力 对 应 大 小 相等 、 方 向 相反 的 接触 力 。 当 摩擦 形 
封闭 存在 时 ， 内 力 必须 分 布 在 摩擦 锥 之 内 。 选 择 例 1 


号 越 大 。 已 经 将 惯性 坐标 系 选 在 物体 内 ， 使 它 的 x 轴 
通过 接触 点 1 和 2 ， 并且 与 接触 点 2 法 向 向 量 共 线 。 


个 摩擦 系数 都 大 了 


F 0.75, 


第 四 部 分 中 的 7 与 9, 和 0, 的 正弦 、 


则 可 以 说 


RIZ, W 


RH 


E 明 摩擦 形 封 闭 存 


图 28.14 由 2 个 手指 共 7 个 关节 组 成 的 


在 。 对 于 该 抓 取 ,由 于 N(OI)nN(G) 20, ERE 
封闭 就 相当 于 力 封 闭 。 

图 28. 13 的 平面 曲线 是 通过 固定 ww =2.0 并 同时 
WE u, 值 生成 的 。 注 意 到 ， 如 果 u <0.75， 力 封闭 
就 不 存在 。 当 jw, Hit us 时， 封闭 度 会 变 得 更 加 平 
缓 。 这 时 候 ， 继 续 增 大 j, 并 不 会 提高 力 封闭 ， 因 为 
接触 点 2 变 成 了 限制 因素 。 为 了 进一步 增加 封闭 度 ， 
两 个 摩擦 因数 都 需要 增 大 。 


球体 抓 取 的 力 封闭 度 


受 第 二 个 接触 
的 摩擦 限制 度 


1.0 


1.5 2.0 2.5 


接触 点 1 的 摩擦 系数 
图 28. 13 接触 点 1 的 力 封 闭 矩 阵 与 摩擦 系数 的 对 应 关系 


平面 机 械 手 抓 取 多 边 形 物体 


-0.6 1 0 
jx = | ) (28. 68) 
-0.8 ° 0 1 


旋转 矩阵 为 
-0.8 


n =( 
0.6 


假设 为 HF 型 接触 ， 
0 1 


-0.8 -0.6 
G-| 0.6 -0.8 (28. 69) 
l mh. jq: =h 


注意 到 G 的 前 两 列 与 接触 点 1 的 单位 切 向 量 和 
单位 法 向 量 相 一 致 。 第 3 和 第 4 列 与 接触 点 2 的 单位 
切 向 量 和 单位 法 向 量 相 一 致 。 

假设 HF 型 接触 并 且 所 有 关节 都 是 活动 的 〈 不 锁 
AER), J 为 


给 定 GA 
1 0 


位 力 所 需 的 扭矩 。 


0. 81, 
- 0. 6L, 
0 


0. 61, 
0. 81, 


(28.70) 


J" boni AY EAR fk An, MA 方向 产生 单 


水 平 线 | 


各 矩阵 分 为 两 部 分 ， 分 别 对 


应 第 一 个 机 械 手指 (上 部 ) 和 第 二 个 机 械 手 指 (下 


200 第 4 篇 


操作 与 接口 


HD). TERRE) J" Fl G 都 是 列 满 秩 的 。 

2. 第 二 部 分 : 抓 取 类 别 

这 个 例子 清楚 地 阐明 了 不 同 抓 取 类 别 的 物理 特性 
而 避免 了 引入 会 混淆 描述 的 特征 。 

我 们 现在 运用 先前 的 平面 例子 来 讨论 四 种 抓 取 类 
别 的 具体 细节 。 在 讨论 过 程 中 为 抓 取 系统 的 参数 选取 
量 纲 的 值 非常 有 用 ,假设 1, 是 单位 长 度 。 那 么 其 
他 长 度 作为 4 的 倍数 分 别 为 


1 =2.7, b=1.0, B=1.7 (28.71) 
1,=1.0, 1;=1.0, 1,=1.0 (28.72) 
l, 21.3, 21.5 (28. 73) 


(1) TRÆ WRN) 是 非 平凡 的 ， 则 存在 


是 活动 的 , Tk (J) =4， 因 此 N(J) 是 三 维 的。 可 
以 得 到 N(7) 的 基 矩 阵 为 


0 0 0 
0 0 0 
0. 50 0. 24 0. 18 
N(J)&| 0.53 0. 67 -0.10 (28. 74) 
0. 48 -0.49 -0.02 


0.48 0.49 0.02 
-0.02 0.01 0.98 

由 于 前 两 行 都 为 0，N(.J) 不 包括 第 一 个 机 械 手 
指 (手掌 的 右 部 ) 的 运动 。 为 了 理解 这 一 点 ,假设 
物体 被 固定 在 平面 上 。 那 么 第 一 个 机 械 手指 不 能 够 保 
持 接 触 在 接触 点 1， 除非 它 的 关节 也 是 固定 的 。 

三 个 非 零 列 数据 与 机 械 手 指 2 相符 ， 表 明了 关节 
有 三 种 基本 运动 使 得 机 械 手 指 能 够 维持 与 物体 的 接 
触 。 例 如 ， 第 一 列 显 示 ， 如 果 关 节 3 大 概 与 关节 4、 
5、6 移动 差不多 的 距离 ， 但 是 与 关节 4、5 移动 反 
向 ， 与 关节 6 同 向 ， 同 时 关节 7 或 多 或 少 被 固定 ， 那 
么 接触 2 会 被 保持 。 
注意 到 机 械 手 指 2 包含 了 一 个 平行 四 边 形 。 由 于 
这 个 几何 结构 ， 我 们 可 以 发 现 向 量 (000—11—11)* 
FEN( J) 的 一 个 元 素 。 该 向 量 的 速度 解释 是 机 械 手 指 
的 连 杆 连 接着 手掌 ， 接 触 物体 的 连 杆 被 固定 在 空间 
中 ， 平 行 四 边 形 以 一 种 简单 的 四 连 杆 组 机 械 装 置 运 
动 。 类 似 地 ,在 NCJ) 中 的 关节 运动 并 不 影响 接触 
力 ， 但 会 引起 内 部 机 械 手 的 速度 。 同 样 注意 到 ， 因 为 
N(J^) =0， 整 个 空间 在 接触 点 处 的 广义 速度 和 广义 
力 可 以 由 该 关节 产生 。 

(2) 不 确定 型 ”如 上 所 述 ， 当 接触 是 HF 模型 
时 ， 系 统 为 可 抓 取 型 。 然 而 ,把 HF 模型 接触 换 做 


PwoF 模型 接触 会 移 除 f 和 方向 上 的 切 向 力 分 量 。 
这 实际 上 是 把 第 2 列 和 第 4 列 从 G 中 移 除 ， 保 证 了 系 


统 是 不 确定 型 。 简 化 后 的 矩阵 记 为 Go) 。 这 种 情形 
FNG) 为 


0 
veo -aa (28.75) 
0. 51 

实际 上 ， 当 目标 物体 逆 时 针 方向 旋转 时 ， 主 向 量 
将 协调 目标 物体 的 运动 ， 以 使 与 (N) 的 原点 相 联系 
的 点 的 运动 方向 向 下 。 同 样 的 ， 如 果 类 似 的 力 和 力 抵 
被 作用 于 物体 上 ， 无 摩擦 的 接触 将 不 能 保持 平衡 。 

(3) 可 抓 取 型 ”具有 两 个 HF 接触 模型 时 ， 秩 
(G) -3, 所 以 N(G) 是 一 维 的 并 且 系 统 是 可 抓 取 
型 。 则 抓 取 和 矩阵 的 零 空间 基 向 量 为 
0. 57 
0.42 
0. 71 

0 

该 基 向 量 是 由 接触 点 两 端 两 个 反 向 作用 的 力 产生 
的 。 并且， 由 于 该 接触 模型 是 理想 的 运动 学 模型 ， 接 
触 点 处 应 不 存在 摩擦 。 然 而 ， 由 这 个 接触 模型 的 内 力 
作用 线 的 法 向 方向 可 知 ， 如 果 摩 氛 系 数 不 大 于 0.75， 
压 紧 的 力 将 在 接触 点 1 处 产生 滑动 摩擦 ， 这 将 与 理想 
运动 学 模型 的 条 件 相 违背 。 

(4) 缺陷 型 ”在 缺陷 型 抓 取 中 ,，N(.) 40, Hi 
于 初始 的 了 是 行 满 秩 的 ， 则 该 抓 取 不 是 缺陷 型 的 。 然 
而 ， 通 过 锁定 一 些 关节 ， 或 者 改变 机 械 手 的 形状 将 有 
可 能 使 J 不 再 行 满 秩 ， 由 此 变 为 缺陷 型 。 例 如 ， 锁 定 
X384, 5,6, 7 将 使 2 号 手指 成 为 只 有 3 个 关节 活 
动 的 单 连 杆 手指 。 在 这 个 新 的 抓 取 系 统 中 ，J, ，, WL 
为 式 (28.70) 中 原始 六 的 前 3 行 ， 其 中 下 标 是 可 以 
自由 活动 的 关节 的 编号 排列 。 此 零 空间 的 主 向 量 是 

0 


N(G) = (28. 76) 


N(Jios)7|u (28. 77) 


因为 存在 一 个 接触 速度 和 接触 力 的 子 空间 ， 它 不 
能 通过 关节 的 广义 速度 和 广义 力 被 控制 ， 所 以 该 抓 取 
是 缺陷 型 的 。 由 于 N(J',,,,) 的 最 后 一 个 元 素 是 非 
零 的 ， 这 个 机 械 手 无 法 在 保持 接触 的 同时 ， 给 物体 上 
的 接触 点 2 一 个 记 方向 的 速度 。 在 诸如 关节 3 的 接 
触 点 2 以 及 其 他 结构 也 存在 这 种 情况 。 也 就 是 说 ， 在 
NCJ") 中 的 力 被 这 些 结构 所 阻止 ， 并 且 这 些 关 节 所 
受 的 载荷 为 零 。 也 就 是 说 ， 这 些 力 已 经 不 是 由 这 个 机 
械 手机 构 所 控制 。 从 另 一 角度 来 看 ， 如 果 接 触 2 的 模 
型 被 无 摩擦 的 关节 机 构 所 替代 的 话 ， 则 NCJ" SS) = 
0， 该 机 构 将 不 再 是 缺陷 型 的 。 
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28.5.3 例 3: 超 静 定 抓 取 


1. 第 一 部 分 : G 和 J 

图 28. 15 显示 了 一 个 三 维 结构 的 平面 投影 ， 半 径 
为 1 的 球 被 具有 三 个 转动 关节 的 单 手指 抓 取 。 以 坐标 
系 [Ch, (Ch, 1CHOS Bbs, X o 方向 指向 图 面 
以 外 〈 如 小 黑 圈 所 示 ) 。 坐 标 系 的 轴 (NL 和 {BE 被 
选 作 与 球 心 原点 一 致 的 轴 。z 轴 指 向 纸 面 以 外 。 由 观 
察 知 ， 因 为 3 个 手指 关节 与 (x, y) 平面 垂直 ， 这 种 
抓 取 会 在 此 平面 上 一 直 起 作用 。 


£ 


图 28. 15 一 个 球体 被 含 三 个 转动 关节 的 机 械 手 指 抓 取 。 
受 力 方向 和 A 同时 属于 N (G) 和 N JD 
因而 引起 了 系统 的 超 静 定性 

假设 所 有 机 械 手 的 连 杆 宽度 是 零 ， 旋 转 和 矩阵 尺 ， 
和 向 量 c, 可 以 由 式 (28.48) 和 式 (28.49) 计算 出 
来 ， 考虑 到 对 于 接触 1, 2, 3, 0, =T, 0,2 7/2, 
9; =0。 最 终 ， 完 整 的 抓 取 和 矩阵 是 GT = (G,G,G,)' e 
R**6， 其 中 G, 由 式 (28.50) 确定 


1 000 0 0 
0 1 00 0 -I 
0 0 1 0 1 0 
0 00 1 0 0 
0 0 0 0 1 0 
0 000 0 1 
0 -10 0 0 0 
1 0 0 0 0 -I 

glo 011 0 0 
Ü 0 0 0 -1 0 
0 0 0 1 0 0 
0 0 0 0 0 1 
-1 0 0 0 0 0 
0 -10 0 0 cj 
0 0 1 0 -l 0 
0 0 0 -1 0 0 
0 0 0 -1 0 
0 0 0 1 


为 构建 完整 的 与 接触 ;有 关 的 机 械 手 结构 的 雅克 比 矩 
阵 ， 需 要 了 解 关节 轴 方 向 和 固定 在 每 个 手指 连 杆 上 的 
坐标 系 原 点 。 假 设 DH 坐标 系 的 原点 在 这 个 物体 的 平 
面 内 。 在 当前 的 条 件 下 ， 接 触 点 1 的 相关 参量 可 以 直 
BUE (NI 表示 出 来 ,为 


c,-£,=(0 1 0)" 
z= (0 0 1)" 
接触 点 2 的 相关 参量 用 (N| 表示 为 


c, -£,- (1 21 0)" 

c,-£ -(0 0)" 

z,-(0 0 1)" 

z,=(0 0 1)" 
接触 点 3 的 相关 参量 用 |N| 表示 为 
c,-¢,= (21 1 0)" 
Rape =f 0)" 
c,-f,=(0 -1 0)' 

z,-(0 0 1)" 

z,=(0 0 1)" 


z,=(0 0 


完整 的 机 械 手 雅克 比 矩 阵 J e RO (接触 速度 
均 以 {C,| RR) 为 


1)" 


-1 0 0 
0 0 0 
0 0 0 
0 0 0 
0 0 0 
1 0 0 
-Ii -1 0 
-2l 0 0 
x 0 0 0 
J=| 0 0 0 
0 0 0 
1 1 0 
l -l -l 
- 2l - 2l 0 
0 0 0 
0 0 0 
0 0 0 
1 1 1 
水 平分 割 线 将 J 分 为 Ji (顶部 ) J, MJ, 


(底部 ) 。 该 列 对 应 于 关节 1 ~3。 
2. 第 二 部 分 : G 和 J 
假设 图 28. 15 中 的 3 个 接触 是 HF 型 的 ， 则 选择 
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JERE H 由 下 式 给 出 : 1 1 0 
100000 1 0 1 
Zr 0100 ] (28. 78) 0 0 0 
000070 1 0 2 
式 中 , 了 和 0 AUR TROU, WERE G eR” MJ e AGE e edo. 38 
0 0 0 
民 ?“ 可 由 消除 相关 旋转 行 来 从 G7 和 J 中 得 到 0 1 0 
1 0000 0 1 0 0 0 0 -1 
0 1 00 0 -i 0 0 0 0 0 0 
0 0 10 1 0 0 0 0 N(G) 子 空间 的 三 个 力 向 量 可 以 很 容易 地 从 图 
0 -100 0 0 1 1 Of 28.15 中 确认 。 注 意 到 所 有 的 受 力 都 是 在 局 部 接触 坐 
G-|1 0 00 0 -I, J=|2 0 0| 标 系 内 表示 的 。N(G) 的 第 一 列 向 量 在 连接 接触 点 1 
0 0 11 0 0 0 0 0| 和 2 的 连 线 方向 上 表现 出 了 反作用 力 。 第 二 列 向 量 参 
-1 0 00 0 0 1 1 L| 数 化 以 后 在 连接 接触 点 1 和 3 的 连 线 方向 表现 出 反方 
0 -100 0 -I 21 21 0| 向 作用 力 。 最 后 向 量 表示 沿 A, 方向 的 力 ， 如 图 
0 0 10 -1 0 0 0 0 28.15 中 的 虚线 所 示 。 注 意 到 该 方向 (在 扭转 强度 空 
3. 第 三 部 分 ， 抓 取 类 型 间 ) 对 应 于 左右 两 个 向 上 的 摩擦 力 和 一 个 两 倍 大 小 
表 28. 10 的 第 一 列 记录 了 这 个 三 个 硬 手 指 抓 持 球 。 的 从 工作 空间 的 项 部 连 杆 中 心 向 下 的 力 。 
最 终 ， 该 抓 取 是 超 静 定性 的 ， 因 为 : 
体 的 例子 中 的 了 和 G” 的 主要 子 空间 的 维 数 。 只 有 非 0 
平凡 零 空 间 被 列 出 。 1 
表 28.10 例 3 研究 抓 取 的 主要 子 空 间 维 数 及 分 类 T 
维 X 类 n N(G)NN(J") =| 0 |40 
dim WJ") =6 缺陷 型 
dim W(G) =3 可 抓 取 型 
dim SJ") AN(G) =1 超 静 定型 0 
| À 在 该 子 空间 内 ， 超 静 定 作用 力 是 无 法 通过 机 械 手 
该 系统 是 缺陷 型 的 ， 因 为 该 结构 可 抵抗 了 空间 的 。 ”关节 控制 的 内 力 。 在 图 28. 15 中 内 力 入 ,在 NCJ 了) 中 
广义 接触 力 ， 对 应 于 零 关节 活动 ed 
Dco]. $e ck oH 图 28. 15 中 的 抓 取 也 是 强力 抓 取 的 一 个 例子 ， 即 
0001 0 0 前 面 提 到 过 的 一 种 抓 取 类 型 ， 它 用 到 了 很 多 接触 点 ， 
— ae E. 不 仅仅 在 指 尖 ， 更 在 手指 及 手掌 中 的 连 杆 上 。 
a Gr GE Ge 所 有 的 强力 抓 取 都 存在 运动 学 缺陷 NJ") z 
"ECT EM 0), FAURE ec eS 根据 28.4.2 节 ， 刚 
体 模 型 不 足以 记录 整个 系统 的 行为 ， 因 为 在 NCG) mn 
=a a E NC) 中 的 广义 接触 力 使 动力 学 不 确定 。 
eo n i 许多 方法 被 用 于 解决 超 静 定 抓 取 中 的 刚体 限制 ， 
"T Vas RR | 28, 12, y 17] vi i 其 
前 三 列 代表 广义 力 在 三 个 接触 点 作用 的 方向 垂直 pa cad di Me he bois 
于 图 28.15 的 平面 。 第 四 列 对 应 一 个 唯一 的 接 甬 力 方 。 下 [28 322] P, A REE AADA 
为 m >q+6, FEP m 是 接触 力 向 量 的 维 数 。 
HY f, 的 应 
该 系统 是 可 抓 取 理 的 ， 因 为 内 力 子 空间 是 三 维 。 28. 5. 4 Ba: 对 偶 性 
WY, “Say RE AY eR EA 考虑 一 个 光滑 的 圆 盘 被 约束 在 平面 内 的 平移 情况 
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( 见 图 28.16)。 在 这 个 问题 上 n, =2， 所 以 适用 于 接 
触 力 与 物体 速度 的 空间 是 二 维 平面 的 。 在 顶部 的 一 对 
图 片 中 ,一 个 单一 的 (固定) 接触 点 的 瞬时 速度 施 
加 了 一 个 半空 间 的 约束 ， 并 将 该 力 限制 在 一 个 射线 的 
光滑 接触 上 。 无 论 是 射线 还 是 (KE) 半空 间 都 
是 由 接触 法 向 指向 对 象 定义 。 注 意 到 射线 和 半空 间 是 
对 偶 的 锥 体 。 当 两 个 接触 出 现时 ，( 浅 灰色 ) 力 锥 成 
为 这 两 个 接触 法 向 的 非 负 空间 ， 且 速度 锥 是 它 的 对 
偶 。 此 外 ， 由 于 存在 第 三 次 接触 ， 抓 取 形 成 了 形 封 
闭 ， 正 如 速度 锥 退化 至 原点 以 及 力 锥 扩展 成 整个 平面 
所 示 。 

重要 的 是 ， 对 偶 锥 的 讨论 适用 于 由 G 的 列 取 代 
接触 法 线 后 的 三 维 机 构 。 


圆 盘 的 二 
维 抓 取 力 和 速度 锥 
I» 
i 力 锥 为 射线 
( x 1 
速度 锥 为 半 平 面 
n y 2 


力 锥 为 平面 


图 28.16 圆 盘 在 平面 内 平移 的 情况 : 无 摩擦 接触 ， 
可 能 的 圆 盘 速度 以 及 净 接触 力 之 间 的 关系 


28.5.5 $15: BAA 


一 个 空间 形 封闭 的 物体 需要 七 个 接触 ， 这 是 很 难 
说 明 的 。 因 此 ， 本 章 唯 一 分 析 的 空间 形 封 闭 的 例子 是 
下 面 的 平面 问题 。 

图 28. 17 是 平面 四 点 抓 取 的 基本 特征 。 请 注 
意 ， 第 四 个 接触 的 法 线 有 明确 界定 ， 尽 管 接 触 是 
发 生 在 对 象 的 顶点 处 。 手 指 的 角度 a 也 是 可 以 有 
所 不 同 的 ， 而 且 当 a 在 区 间 1.0518 «oa < m/2 内 
的 时 候 可 以 证 明 形 封闭 存在 。 注 意 到 a 的 临界 值 
当 C, 下 沿 含有 接触 点 3 (a~1.0518) 和 接触 点 2 
(a2m/2), 


图 28.17 如 果 1.0518 «a < 7m， 具有 一 阶 形 封 闭 的 平面 抓 取 


选择 用 于 分 析 的 坐标 系 ， 并 选取 第 四 个 接触 点 为 


坐标 原点 ， 则 此 例 的 抓 取 矩阵 为 
0 0 1 —cos(a) 
gz)! 1 0 sme) | (2879) 
7 
-l 0 FE 0 
如 图 28.18 所 示 ， 形 封闭 在 一 定 的 角度 范围 内 进 
行 了 测试 。 这 表明 ， 抓 取 失 去 形 封闭 的 最 远 距 离 为 
a 二 1. 22rad， 正 如 图 中 所 示 形 态 。 
度量 
0.7 
0.6 
0.5 
0.4 
0.3 
0.2 
0.1 
01 12 1.4 1.6 1.8 
接触 角 
图 28. 18 如 果 1.04 <a «1.59, 封闭 度量 角 与 接触 角 关 系 
28.6 结论 与 扩展 阅读 


抓 取 系 统 总 体 上 可 以 按照 简单 的 线性 运动 学 、 动 
力学 和 接触 模型 进行 理解 。 使 用 最 广泛 的 分 类 、 封 闭 
性 抓 取 都 可 以 以 这 些 刚体 模型 的 假设 为 依据 。 由 这 些 
线性 化 的 模型 可 以 有 效 地 利用 计算 线性 代数 和 线性 规 
划 技 术 的 矩阵 和 测量 来 进行 研究 。 人 参考 文献 【28. 11, 
16, 21, 32-36] 是 对 抓 取 运 动 学 以 及 抓 取 的 分 类 的 
深入 研究 讨论 。 但 当 进 行 简化 假设 的 时 候 ， 人 们 必定 
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想 知 道 丢 失 了 哪些 深入 概念 。 有 兴趣 的 读者 可 以 
自己 参考 一 下 更 复杂 的 假设 下 对 抓 取 系统 进行 分 
析 的 文献 。 总 体 来 讲 ， 大 多 数 的 机 构 可 以 分 为 弯 
的 和 柔顺 的 .031。 接触 摩擦 模型 并 不 
像 库仑 近似 那样 简单 地 可 以 如 此 广泛 地 被 采用 ， 
正如 本 章 所 介绍 的 ; 例如 ， 如 果 接 触 必须 抵抗 
个 法 向 力矩 ， 其 有 效 切 向 摩擦 系数 将 会 降低 ”| 。 
在 我 们 分 析 看 来 ， 二 次 库仑 摩擦 锥 是 由 一 个 多 面 
体 锥 来 近似 的 。 若 使 用 二 次 锥 模型 分 析 问 题 将 使 
问题 变 得 更 加 复杂 困难 ,但 十 分 容易 处 理 '*””1。 
原则 上 ,一 个 妥善 设计 的 手 -物体 系统 可 以 在 控制 
下 ,维持 所 有 接触 ,但 实际 情况 下 也 极 可 能 会 导 
致 不 必要 的 滑动 或 转动 。 

抓 取 系统 领域 内 的 其 他 重要 研究 课题 是 : 抓 取 综 
合 、 力 分 布 、 稳 定性 ， 以 及 灵巧 操作 。 抓 取 综合 其 实 
是 手 接触 点 位 置 和 姿态 的 选择 ， 以 及 优化 抓 取 质 量 的 
问题 。 请 注意 ， 这 是 一 个 与 抓 取 获 得 相当 不 同 的 问 
题 ， 后 者 指 的 是 实现 所 选 抓 取 的 行为 。 抓 取 获 得 是 一 
个 灵巧 操作 行为 。Jameson 在 1985 年 的 研究 是 对 多 手 
指 机 械 手 抓 取 结 构 的 最 早 研 究 之 一 :1 ， 他 还 设计 
了 Levenberg- Marquardt 算法 来 搜索 物体 表面 的 三 点 位 
置 ， 以 实现 在 物体 表面 的 力 封闭 。 自 这 项 研究 以 后 ， 
许多 其 他 寻找 高 品质 的 抓 取 的 指标 和 办 法 相继 出 现 
(例如 参考 文献 [28. 42-47] ) , Liu 等 人 最 近 发 表 了 
一 篇 深入 讨论 几 种 高 质量 指标 的 学 术 论 文 。 在 文章 
中 ， 他 们 进一步 证 明 ， 如 果 通 过 优化 指标 选择 手指 的 
接触 位 置 ， 并 且 如 果 一 个 力 封闭 抓 取 存 在 ， 则 取得 的 
抓 取 是 力 封闭 的 中。 对 于 多 个 对 象 的 同时 抓 取 ， 
请 参见 参考 文献 [28.49], 

抓 取 力 的 分 布 问题 实际 是 ， 找 到 合适 的 连接 关 
节 和 接触 力 来 平衡 给 定 的 施加 在 物体 的 外 部 已 知 负 
载 。 此 问题 已 首先 由 McGhee 和 Orin 两 人 在 行走 机 
器 人 中 进行 了 研究 ”i， 后 来 又 有 了 其 他 的 一 些 研 
ZUR! Kumar 和 Waldron 将 类 似 的 技术 应 
用 到 抓 取 力 的 分 布 问 题 上 ”1。 最 近 Han 等 人 和 
Buss 等 人 又 做 了 一 些 研 究 , 已 解决 了 非 线 性 摩擦 锥 
约束 ， 采 取 二 阶 锥 规划 和 相关 技术 和 ?5 。 在 强 
力 抓 取 中 ， 这 个 问题 更 为 复杂 ， 因 为 可 能 存在 不 适 
用 的 接触 力 的 情况 ， 如 参考 文献 [28.17, 19, 20, 
55a 


| 


抓 取 稳定 性 往往 等 同 于 抓 取 的 封闭 性 ， 因 为 在 封 
闭 条 件 下 所 有 的 外 力 可 以 通过 机 械 手 平衡 。 然 而 ， 抓 
取 的 封闭 实际 上 相当 于 平衡 的 存在 ， 这 是 稳定 性 存在 
的 一 个 必要 条 件 ， 但 不 是 充分 条 件 。 稳 定性 在 机 器 人 
抓 取 领 域 以 外 的 常见 定义 是 ， 当 一 个 系统 偏离 一 个 平 


衡 点 时 ， 系 统 能 返回 到 这 个 点 。 这 是 由 Hanafusa 和 
Asada 提出 的 。 他 们 研究 了 有 三 个 弹性 手指 的 机 械 手 
的 抓 取 稳定 性 "9 Cuskosky 在 三 维 情况 下 进行 了 这 
个 分 析 并 考虑 了 手指 与 物体 曲率 的 关系 ”1。 他 发 
现 ， 稳 定性 是 依赖 于 手指 和 控制 器 的 刚度 以 及 接触 物 

灵巧 操纵 的 研究 最 早出 现在 20 世纪 70 年 代 的 
文献 中 。Hanafusa FI Asada 制定 了 一 项 计划 ， 将 螺 
母 旋 进 螺栓 5 。 自 那 以 后 ， 日 益 复 杂 的 操作 任 
务 已 经 在 不 同 程度 的 细节 上 被 研究 并 有 了 很 大 的 
HERE, Mason 和 他 的 许多 学 生 研 究 了 水 平面 内 推 操 
作 任 务 的 课题 ， 例 子 见 参考 文献 [28. 58-61] 。 其 
他 值得 注意 的 平面 工作 见 参 考 文献 [28. 62-66] 
灵巧 操作 任务 在 三 维 空间 中 的 规划 和 执行 在 机 器 
人 学 中 仍然 是 一 个 开放 式 问 题 。 然 而 ， 仍 出 现 了 
一 些 有 趣 的 方法 和 许多 有 用 的 见解 ， 推 荐 阅读 参 
考 文献 [28. 67-72 ] 
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合作 机 械 手 


Fabrizio Caccavale, Masaru Uchiyama 


USA EE 


本 章 主 要 介绍 了 两 个 或 两 个 以 上 机 械 臂 共同 完 
成 任务 的 合作 作业 。 开 篇 回顾 了 合作 作业 自 20 世 
纪 70 年 代 初 至 今 的 发 展 历史 。 对 合作 机 械 手 牢固 
抓 持 刚 体 的 运动 学 和 动力 学 模型 进行 了 深入 研究 ， 
例如 依靠 对 称 方程 来 描述 系统 的 运动 学 和 静 力 学 
等 。 同 时 也 讨论 了 动力 学 及 封闭 运动 链 降 阶 模型 的 


一 些 基础 问题 。 
对 一 些 具体 问题 ， 如 定义 具有 几何 意义 的 合作 


工作 空间 变量 ， 负 载 分 配 问 题 以 及 定义 可 操作 性 椭 
球 等 ， 为 读者 提供 了 详尽 的 模型 图 片 以 及 合作 操作 
的 评价 指标 。 对 合作 机 械 手 的 运动 及 机 械 手 与 刚体 
之 间作 用 力 的 主要 控制 方法 进行 了 详细 的 介绍 ， 包 
括 力 /位 混合 控制 、 比 例 一 微分 (PD) 力 / 位 控制 、 
线性 反馈 控制 ， 以 及 阻抗 控制 等 。 在 最 后 一 节 提 出 
了 合作 机 械 手 的 先进 控制 方法 ， 并 简要 地 讨论 了 先 
进 非 线性 控制 策略 (包括 智能 控制 方法 ， 同 步 控 
制 ， 分 散 控制 ) ， 还 给 出 了 具有 一 定 柔 万 度 的 合作 
系统 建 模 以 及 控制 的 基本 结果 。 


29.1 发 展 历史 概述 


机 器 人 技术 出 现 不 入， 科学 家 就 开始 了 多 手臂 
机 器 人 系统 的 探索 。 该 研究 始 于 20 世纪 70 年 代 初 ， 
主要 是 源 于 单 臂 机 器 人 作业 中 的 典型 受 限 问题 。 事 
实证 明 ， 单 辟 机 器 人 难以 完成 的 任务 可 由 两 个 或 两 
个 以 上 机 械 手 合作 完成 。 这 些 任 务 包括 移动 质量 及 
体积 庞大 的 载荷 ， 不 使 用 特殊 的 装置 实现 多 部 件 组 
装 ， 处 理 柔 性 或 具有 宛 余 自由 度 的 对 象 等 。 合 作 机 
械 手 的 研究 旨 在 解决 现存 问题 并 开展 其 在 柔性 制造 
系统 及 不 良 结构 环境 中 (例如 外 太空 及 海底 环境 ) 
新 的 应 用 。 

Fujii 和 Kurono ?! . Nakano 等 人 [22.3] 以 及 Takase 
等 全 作为 多 手臂 机 器 人 早期 研究 工作 的 代表 ， 其 
研究 内 容 的 关键 技术 主要 包括 主 从 控制 、 力 /柔顺 控 
制 及 工作 空间 控制 。 在 参考 文献 [29.1] P, Fujii 
和 Kurono 提出 了 用 于 多 臂 机 器 人 协调 控制 的 柔顺 控 


29.1 发 展 历 史 概 述 HMM 207 
29.2 运动 学 和 静 力 学 和 pp 208 
29.2.1 对称 方程 pp 209 
29.2.2 多 指 手 操作 ppp 210 
29.3 协同 工作 室 间 e 211 
29.4 TIE RÍAS e MM 212 
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29.5 THER EJA e MM 214 
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29.601 EJER V MM 214 
29.602 PD 力 / 位 控制 cercece rece ee ee ee eee eee een ees 215 
29.6.3 线性 反馈 方法 pp 216 
29.6.4 阻抗 控制 pp 216 
29.7 BRU BA EDA TSE MM 217 
DIDA m 217 


制 方法 ， 定 义 了 相对 于 被 控 对 象 坐标 系 的 任务 向 量 
在 该 坐标 系 下 控制 作业 的 柔顺 性 。 

Fujii, Kurono 9 及 Takase 等 人 [33] 的 研究 具有 
一 个 典型 特征 ， 即 不 利用 力 / 力 和 矩 传 感 器 ， 而 利用 出 
动 器 后 退 操作 的 灵活 性 实现 力 /柔顺 控制 。 当 时 ,由 
于 研究 者 专注 于 使 用 力 / 力 矩 传感器 实现 更 复杂 控制 ， 
因此 该 技术 在 实际 应 用 中 的 重要 性 并 不 被 认同 。Na- 
kano 等 人 呈 ? 和 提出 了 一 种 主 从 力 控制 方法 ， 用 于 控 
制 搬运 同一 物体 的 两 机 械 臂 的 协调 运动 ， 并 指出 了 力 
控制 对 合作 机 械 手 协调 作业 的 重要 性 。 
基于 一 些 单 手 臂 机 器 人 的 基本 研究 结果 ， 在 20 
世纪 80 年 代 恢 复 了 对 多 手臂 机 器 人 强大 的 研究 工 
作 '” 引 。 主 要 包括 相对 于 被 控 对 象 任务 向 量 的 定 
义 * 中 ， 多 手臂 机 器 人 与 被 控 对 象 构成 封闭 运动 链 系 
统 的 动力 学 和 控制 个， 以 及 力 控 制 问 题 ， 如 力 / 位 
混合 控制 ”路 等。 这 些 研究 工作 为 多 手臂 机 器 人 的 
控制 形成 了 有 力 的 理论 支撑 ,并 为 从 20 世纪 90 年 代 
至 今 更 多 先进 控制 方法 的 研究 莫 定 了 基础 。 
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如 何 基 于 动态 模型 的 约束 力 将 整个 协作 系统 参数 
化 ， 是 一 个 很 重要 的 问题 。 事 实 上 ， 参 数 化 实现 了 用 
于 控制 的 任务 变量 的 定义 ， 并 解决 了 多 手臂 机 器 人 领 
域 中 最 常见 问题 : 包括 如 何 同时 控制 物体 的 轨迹 、 作 
用 于 被 控 对 象 的 机 械 应 力 ( 内力/ 力矩 )、 手 辟 之 间 
的 负载 分 配 以 及 物体 的 外 部 作用 力 / 力 矩 。 由 于 力 分 
解 是 解决 这 些 问 题 的 关键 D UE, Uchiyama, 
DauchezP?'?) 和 Walker 等 人 中 以 及 Bonitz , 
Hsiat” 中 对 此 进行 了 研究 。 如 何 构 造 具 有 清晰 几何 意 
义 的 作用 于 物体 的 内 力 /力矩 成 为 一 个 问题 ，Williams 
和 Khatib 给 出 了 一 个 解决 方法 ， 即 参数 化 思 
想 。 基 于 这 种 方法 设计 了 一 些 合作 控制 策略 ， 包 括 运 
ay AM Hy AY Ps BOO! ， 以 及 阻抗 /柔顺 控 
1807777. 相应 的 一 些 研究 还 包括 自 适应 控 
$7229. ize]. TAEZ Via] OPP) X 
Trading 0» 7909! DA Be gaps qp E 

在 20 世纪 90 年 代 ， 用 于 协调 控制 ”的 面向 
用 户 任务 空间 变量 的 定义 以 及 更 加 有 效 的 评价 方 
法 所 3 都 得 到 了 广泛 的 研究 。 

许多 已 经 发 表 的 学 术 论 文 空 ”2 显示， 机械 
手 之 间 的 负载 分 配 仍然 是 一 个 重要 议题 。 当 机 械 
手 抓 持 物体 但 没有 抓 牢 时 ， 为 保证 手臂 之 间 最 理 
想 的 负载 分 配 以 及 抓 持 的 稳定 性 ， 而 提出 了 负载 
分 配 的 问题 。 在 这 种 情况 下 ， 负 载 分 配 问题 变 成 
了 可 以 用 启发 式 方法 或 数学 方法 解决 的 
最 优化 问题 。 

一 些 研 究 工作 则 更 关注 于 对 多 体 或 柔性 对 象 的 协 
作 操 作 '*“”。 由 于 柔性 手 辟 机 器 人 可 在 协作 系统 
中 使 用 的 优点 ， 即 ， 轻巧 的 构造 ， 固 有 的 柔顺 
性 和 安全 性 等 ， 多 柔性 臂 机 器 人 的 控制 的 研究 也 得 到 
TREIS, 

EPE, UR AE AS METE STE 2] 777. DLR 
手 末端 执行 器 在 物体 上 有 滑动 的 前 提 下 将 可 能 稳定 地 
抓 住 物 体 。 

最 近 提 出 用 于 合作 系统 的 控制 策略 ， 被 称 为 同步 
控制 >””| ,在 该 方法 中 ， 控 制 问题 以 协作 任务 中 
机 械 手 之 间 运 动 同步 误差 的 定义 形式 加 以 公式 化 ， 而 
合作 作业 系统 的 非 线 性 控制 ， 则 主要 致力 于 智能 控制 
( 见 参考 文献 【29. 51] 和 参考 文献 【29.52] ， 在 这 
两 个 例子 中 ， 利 用 模糊 控制 来 处 理 非 建 模 动力 学 ， 参 
量 不 确定 因素 以 及 干扰 ) 及 局 部 状态 反馈 控制 
策略 3 。 

如 何在 传统 工业 机 器 人 上 实现 合作 控制 已 经 引起 
了 研究 者 们 越 来 越 大 的 兴趣 。 事 实 上 ， 工 业 机 器 人 的 
控制 单元 并 不 能 体现 非 线性 转 矩 控制 策略 的 全 部 特 


性 ， 在 标准 工业 机 器 人 控制 单元 上 集成 的 力 / 力 失传 
感 需 总 是 笨重 的 ， 并 且 由 于 多 种 原因 而 被 禁止 应 用 于 
工业 上 : 如 不 可 靠 性 、 成 本 等 。 因 此 ， 在 工业 生产 
中 ， 早 期 控制 方法 的 重新 利用 ， 而 不 是 使 用 力 传 感 
器 (Fujii 和 KuronoU*!! , Inoue 7 1) 变 得 很 有 吸 
引力 ， 且 已 经 成 功 地 实现 了 无 力 /力矩 传感器 的 力 
/位 混合 控制 ' 交 5 。 工 业 机 器 人 实现 有 效 协 作 控制 
策略 的 成 果 见 参考 文献 [29. 56] ， 在 例子 中 ， 提 
出 了 一 种 基于 工具 坐标 系 、 轨 迹 生 成 和 多 机 器 人 
的 分 散 控制 方法 。 

另 一 个 引 人 关 注 的 方面 是 参考 文献 [29.57] 
研究 了 与 可 靠 性 和 安全 性 相关 的 协作 作业 系统 。 
参考 文献 [29.57] 认为 使 用 非 刚 性 手 爪 的 目的 
是 为 了 避免 过 大 的 内 应 力 ， 即 使 抓 持 失败 或 与 环 
境 产生 非 预期 性 的 接触 ， 也 可 以 保证 作业 的 
安全 。 

最 后 ， 值 得 一 提 的 是 ， 在 利用 多 手指 / 手 抓 持 物 
体 (在 第 28 章 中 有 较 多 的 描述 ) 与 协作 作业 问题 之 
间 有 着 密切 的 关系 。 事 实 上 ， 多 机 械 手 系统 可 以 在 各 
种 情况 下 抓 住 一 个 普通 的 作业 对 象 。 在 多 指 手 的 作业 
中 ， 只 有 某 些 运动 分 量 是 通过 接触 点 传送 到 被 控 对 象 
上 的 ( 单 侧 约 束 ) ， 而 机 器 人 手臂 之 间 的 合作 作业 是 
通过 刚性 (或 近似 刚性 ) 抓 持 点 及 发 生 在 该 抓 持 点 
上 的 运动 量 传递 的 相互 作用 来 实现 的 。 然 而 在 这 两 个 
领域 中 ， 很 多 问题 通常 都 可 以 通过 一 种 概念 上 近似 的 
方法 来 解决 (如 运动 学 模型 ， 力 控制 )， 而 其 他 一 些 
问题 则 是 各 自 应 用 领域 中 的 特殊 问题 (例如 多 指 手 
的 形 封闭 和 力 封闭 ) 。 参 考 文献 【29.25] 已 经 提出 
了 关于 协作 作业 和 多 手指 操作 的 通用 坐标 系 ， 通 过 建 
立 有 移动 /旋转 关节 的 接触 模型 来 描述 考虑 物体 抓 持 
点 的 滑动 /旋转 。 因 此 ， 可 根据 被 控 对 象 的 期 望 运动 
轨迹 ， 利 用 逆 运 动 学 模型 求 取 机 械 辟 /手指 的 期 望 关 
节 轨 迹 。 


运动 学 和 静 力 学 


假定 系统 由 M 个 机 械 手 组 成 ， 每 个 机 械 手 
包括 W G=1, =, M) PRB, pO LITE 
具 坐 标 系 总 相对 于 基础 坐标 系 总 的 3 x ERE 
矢量 ; RON SEDIT AERIS RA S HUS x 3 方 
位 矩阵 。 
根据 正 向 运动 学 方程 ,p, 和 尺 , 均 可 以 表示 为 每 个 
机 械 手 关节 变量 g, 的 N, x 1 维 向 量 函数 

is 
R,=R;(q;) 


29. 2 


(29.1) 
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当然 ， 工 具 坐标 系 的 方位 可 以 用 一 个 角度 极 小 

集 来 表示 ， 例 如 可 以 用 三 个 一 组 的 欧 拉 角度 办 来 表 

示 。 因 此 ， 由 操作 空间 向 量 x; 描 述 的 正 向 运动 学 方 
程 为 


ra) sl T 
ducem " = . 
DEC eae) 


线 速度 p, fü XE FE mw 组 成 的 6 维 列 矢 量 v, = 
(pl o 可 表示 第 i 个 末端 执行 器 的 广义 速度 v;o 
因此 ， 正 向 运动 学 微分 方程 可 以 表示 为 
vi 2Ji(q))d, (29.3) 
AP, 7/ 为 6xmN 的 偏 导数 矩阵 ， 称 为 第 ; 个 机 械 手 
的 几何 雅 可 比 和 矩阵 〈 见 第 1 章 ) 。 利 用 操作 空间 向 量 
2X; 的 微分 形式 表示 速度 ， 微 分 运动 学 方程 则 可 表示 为 
与 上 式 相似 的 形式 


35494, Ila 4s 


式 中 ,J 是 第 i 人 ee oie 
( 见 第 1 章 )。 

当 机 器 人 与 外 界 环境 相互 作用 时 ， 在 接触 的 地 方 
PEISAJE n, RAR i RIMITA AI X 
H, 用 6 x1 列 向 量 UN AJ 


- 
h,= 
n; 


RP, fL n; 分 别 是 力 和 力矩 。 根 据 虚 功 原 理 ， 将 
式 (29.3) 代入 虚 功 方程 可 得 
t; =J'(q,)h, (29.6) 


(29.4) 


(29.5) 


杆 ， 称 之 为 虚拟 杆 ”"” ， 用 于 确定 SB。 相对 于 S. 


(=1，2) 位 置 。 当 被 控 对 象 为 刚体 且 被 机 械 手 抓 牢 
时 ， 每 一 个 虚拟 杆 在 坐标 系 S, CI) 中 表示 为 一 


个 常数 向 量 。 因 此 ， 每 个 机 械 手 的 正 向 运动 学 可 表示 
为 虚拟 工具 坐标 系 Ss = SO MIBK, AS S.A 
的 方向 及 起 始 坐 标 ps,; =p; +r; =p。。 因 此 ， 每 一 个 虚 
拟 杆 项 端的 位 置 和 方向 由 ps; m pc, Rs; =Ro (i=l, 
2) 来 表示 。 

对 应 于 Ry ,的 欧 拉 角 由 3 x 1 列 向 量 办 ,表示 。 假 
定 被 控 对 象 为 刚体 (或 接近 刚性 ) 且 紧 密 地 (或 接 
近 紧 密 ) 与 每 一 个 末端 执行 器 接触 ， 则 可 认为 上 述 
坐标 系 之 间 的 距离 为 零 或 可 忽略 。 和 否则 ， 如 果 被 控 对 
象 有 变形 (例如 柔性 物体 ) 或 抓 持 不 紧 (例如 柔顺 
的 手 爪 )， 则 上 述 坐 标 系 间 产 生 的 位 移 将 不 可 忽略 。 
JH hu ,表示 作用 于 第 i 个 虚拟 杆 顶 端的 广义 力 矢量 ， 
则 可 得 到 下 式 


I, 
h, , = 
i feces 


式 中 ,0O, 和 工分 别 表 示 零 矩阵 和 1 x1l 单 位 矩阵 ; S 
(r;) 是 3 x3 斜 对 称 矩 阵 又 积 。 值 得 注意 的 是 W, iR 
终 满 秩 。 

根据 虚 功 原 理 ， 由 式 (29.7) 可 得 


L SC) ý 
VES s; = Wivs; (29.8) 
0, I, 


式 中 , vs ;是 虚拟 杆 末 端的 广义 速度 矢量 ,， 当 ,=0 
If, W,=1,. Maz, 如 果 每 个 机 械 手 末端 执行 器 的 
运动 学 对 应 相应 的 虚拟 杆 (或 将 被 控 对 象 简化 为 一 


0, 
h,=W,h, (29.7) 
I, 


式 中 ,Ti 为 第 i 个 机 械 手 的 N, x 1 关节 力 / 力 矩 矢 量 。 

为 方便 研究 ， 以 两 个 机 械 手 合作 操纵 一 个 被 控 对 
象 的 系统 为 例 ( 见 图 29.1) 进行 分 析 。 设 C 为 被 控 
对 象 上 的 固定 点 〈 如 质心 ) ，Pc 为 其 在 基础 坐标 系 中 
的 位 置 坐标 向 量 ，N6 为 被 控 对 象 的 坐标 系 。 假设 向 
Er (i=1, 2) 为 固定 于 第 i 个 末端 执行 器 的 刚体 


图 29.1 双 臂 合作 机 械 手 抓 取 一 般 被 控 对 象 的 坐标 系 


点 ) ， 则 两 个 未 端 执 行 器 的 力 及 速度 与 它们 虚拟 杆 上 
的 对 应 点 是 一 致 的 。 


29.2.1 对 称 方程 


基于 被 控 对 象 与 机 械 手 末端 执行 器 (虚拟 杆 的 
末端 ) 相应 位 置 上 广义 力 / 速 度 之 间 运 动 学 和 更 力学 
KA, Uchiyama 和 Dauchez 提出 了 动态 静 力 方 
Fe?) BTS A PRT EE 

首先 定义 外 力 为 6 x 工 广义 力 矢 量 ， 如 下 式 
所 示 


hs =hs, +hs, = Wshs (29.9) 
式 中 ,Ws = (1 I), h-(Bs, hy); hs 为 引起 
物体 运动 的 广义 力 矢量 。 由 式 (29.7) M (29.9) 
可 知 ，hs 可 表示 为 末端 执行 器 受 力 的 函数 

h; = Wih, + W,h, = Wh (29. 10) 
(WW), 有 =(h hy)"; Ws 是 表示 
s 间 的 6 x 12 抓 持 矩阵 ， 其 中 包括 六 维 列 


AP, W= 
抓 持 几何 空 
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空间 和 六 维 零 空 间 。 


反 解 式 (29.9) 可 得 . 
h, = Wh, + V;h, =U;ho (29. 11) 
其 中 WA W.B SE 
1 (4s 
‘= 一 29. 12 
Ws = n (29. 12) 


矩阵 Vs 的 列 元 素 为 WAS — PE, dn. 


-I, 
V. = 
S I, 


h,-(h; h),U,-(Wi Vs) (29.14) 

x (29.11) 等 号 右 侧 第 二 项 V h Y WE 

阵 零 空间 的 虚拟 杆 顶 端 广义 力 矢量 。 由 于 这 些 力 不 属 

于 外 力 ， 因 此 , 6 x1 矢量 有 不 是 引起 物体 运动 的 广 

义 力 ， 它 代表 了 物体 的 内 部 载荷 ( 即 机 械 应 力 )， 是 
AR”), mE, R (29.10) 得 

h = W'h, + Vh, = Uh, (29.15) 

U-(W V) (29.16) 

根据 参考 文献 [29.13], HPF E BE II DLE TE. 

定时 ， 式 (29.15) 等 号 右 侧 第 一 项 代表 唯一 的 有 用 

外 力 ， 即 


(29. 13) 


1 
ah 0, 

1 1 

FS) 34, 

W= i (29.17) 

ah 0, 

1 1 

380) ah 


与 式 (29.11) PV AA, HERE Y 的 列 元 素 涵盖 
W 的 零 空 间 ， 见 参考 文献 [29.30], 


式 中 ， vs = (Vs Waa) vo = (VE Vj. 矢量 vy AT 
以 理解 为 物体 的 绝对 速度 ， 刀 代表 固定 于 虚拟 杆 项 端 
的 两 个 坐标 系 Ss 及 s,2 HAARE E : 当 被 控 对 


象 为 刚体 且 难 以 抓 住 时 ， 速 度 矢 量 为 去。 同 理 ， 根 据 
式 (29.15)， 可 得 到 以 下 映射 
vo 2 U'v (29.22) 


xm, y= (vi ia 
根据 参考 文献 [29.12, 25], 5 v, RI v XE BU 
位 置 及 方向 变量 可 定义 为 


Py = 村 (Ps +Psa)，Pi =Ps2 - psa (29.23) 
R,-RQR(k /2), RI =R, (29.24) 
式 中 ，R; =r, R, 表示 N, 相 对 于 N, Abi HH BS 7r In] AB 
阵 ， 避 ,和 轨 , 分 别 为 当量 单位 向 量 (相对 于 SS 及 
由 表示 确定 相对 方向 (由 Rio) 的 转角 。 因 此 ， 
可 将 RE 旋转 某 一 需要 的 角度 (总 与 ,对 齐 角 度 的 
AE) 来 代表 一 个 关于 三 ,的 转角 。 
如 果 由 欧 拉 角 表 示 方 向 变量 ， 


o 
Xy = 9 
Pr 

1 
Pr BEREIT t€.) (17855 7985, (29. 26) 


然而 ， 必 须 强调 的 是 ， 只 有 在 虚拟 杆 和 坐标 系 之 
间 的 方向 偏 移 量 很 小 时 ， 式 (29. 26) 中 的 变量 才 具 
有 清晰 的 几何 意义 。 在 这 种 情况 下 ， 如 参考 文献 
[29.11, 12] 所 述 ， 相 应 的 操作 空间 速度 xs 和 并 分 
别 对 应 于 相应 的 vy 和 vw ， 且 有 很 好 的 近似 值 。 否 则 ， 
如 果 方 向 偏 移 量变 大 ,， 式 (29.26) 中 的 变量 没有 任 
何 意义 ， 必 须 采 用 其 他 的 定义 形式 。 例 如 ， 单 位 四 元 
数 法 (unit quaternion) ( 见 第 1 章 对 于 四 元 数 的 简单 


RS 


则 操作 空间 变量 为 


(29.25) 


-I, 0, 
-S(n) -1L 

= (29.18) 
I, 0, 
S(r,) L 


IÈ (29.9) 和 式 (29.10) 的 参数 化 逆 解 可 分 别 


表示 为 


hs -Wih, + (Iņ - Ws Ws )hs 
h=W'h, + (I, -W'W)h* 


(29. 19) 
(29. 20) 


XB, hs (h*) 表示 第 i 个 虚拟 杆 (第 i 个 末端 执 
行 器 ) 顶端 的 一 个 任意 12 x1 J MARE, 它 由 
I,-Wi;W,(l,-W'W) IJE] W (W) 的 零 空间 。 

根据 以 上 推导 ， 利 用 虚 功 原理 可 建立 广义 速度 的 
映射 因此， 与 式 (29.11) 对 应 的 映射 为 


T 
Vo m Usvs 


(29. 21) 


介绍 和 29. 3 节 合 作 机 器 人 的 运动 学 的 应 用 ) 。 


最 后 ， 根 据 式 (29. 


15), X (29.22), X 


(29.3) 及 式 (29.6)， 可 获得 被 控 对 象 力 /速度 与 机 
械 手 关 节 空 间 对 应 量 之 间 的 动态 静 力 映射 


T=J ho (29. 27) 
vo =Joq (29.28) 
式 中 , T= (TT D)" = h)", Jo=U"J,J = 


J, 
0, 


(29. 29) 


0, 
J; 


同 理 ， 可 建立 操作 空间 速度 x HL ag 
应 的 操作 空间 力 /力矩 之 间 的 映射 。 


29.2.2 多 指 手 操作 


本 章 描述 了 多 手臂 合作 机 械 手 人 研究 领域 的 一 些 联 
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系 ， 对 第 28 章 中 的 多 指 手 操 作 进 行 了 简要 概述 ， 并 
分 析 了 两 类 多 手 辟 操作 系统 的 动态 静 力 学 。 

主要 包括 多 手臂 合作 系统 和 多 指 手 操作 系统 ， 两 
个 或 两 个 以 上 的 机 械 手 抓 持 一 个 被 控 对 象 等 。 

合作 操作 有 的 利用 多 个 机 械 辟 刚性 的 抓 持 被 控 对 
象 (例如 通过 刚性 夹 持 器 ) ， 并 通过 传递 作用 在 抓 持 
点 上 的 力 /力矩 来 产生 相互 作用 ， 即 通过 抓 持 点 传递 
所 有 的 平移 和 回转 运动 分 量 。 

当 多 指 手 操 纵 一 个 被 控 对 象 时 ， 只 通过 接触 
点 传输 某 些 运动 分 量 。 根 据 接触 类 型 ， 合 理 地 定 
义 约 束 和 矩阵 可 有 效 地 建立 该 运动 模型 。 换 句 话说 ， 
由 约束 矩阵 充当 滤波 器 来 选择 可 通过 接触 点 传递 
的 运动 分 量 。 事 实 上 ， 如 第 28 章 所 述 ， 物 体 一 手 
指 之 间 的 接触 点 有 两 个 ， 分 别 为 手指 尖 上 的 一 点 
和 物体 上 的 一 点 。 因 此 ， 第 i 个 接触 点 的 两 个 广义 
速度 矢量 ( 均 相 对 于 坐标 系 I) 分 别 为 : PER 
触 点 速度 vv, 和 物体 上 接触 点 的 速度 名;。 对 应 的 
广义 力 矢 量 分 别 是 hi M hio (BEBE m, 个 速度 分 量 
依靠 接触 速度 ;传输 ， 则 利用 m; x6 约 东 和 矩阵 H 
定义 接触 模型 


vi, = Hy, =Hy', (29. 30) 
与 式 (29.30) 对 应 的 广义 力 方 程 为 : 
Hih,, = hy; = hi; (29. 31) 


SUP, hi ;为 被 传递 的 广义 力 矢 量 。 因 此 式 (29.10) 
可 写 为 
hs =WRHIh!, +W,R,Hjh?, (29.32) 

IP, R, = diag |R;，R,| 。 由 此 ， 概 念 相似 的 动态 
静 力 学 分 析 得 到 了 发 展 ， 并 引出 了 外 力 和 内 力 的 概念 
(与 运动 学 相关 的 量 ) 。 

值得 注意 的 是 ， 内 力 通 常 对 多 机 械 臂 牢固 抓 
持 物 体 产 生 不 利 的 影响 (除非 获得 可 变形 物体 的 
被 控 压 缩 量 ) 。 而 当 适 当地 控制 多 指 机 械 手 的 内 
力 ， 即 使 有 外 负载 作用 于 被 控 对 象 ， 也 有 利于 保 
证 抓 持 的 牢固 性 。 (如 第 28 章 所 述 的 建 模 和 力 封 
闭 问 题 ) 。 


29.3 协同 工作 空间 


参考 文献 [29.25, 26] 简要 回顾 了 为 协同 工作 
空间 而 定义 的 以 任务 为 导向 的 方程 式 。 根 据 式 
(29.23) 和 式 (29.24), ， 以 绝对 和 相对 运动 形式 直 
接 定 义 了 合作 系统 的 任务 变量 ， 该 变量 可 直接 从 工具 
坐标 系 的 位 置 /方向 中 获得 。 

绝对 坐标 系 NM, 相 对 于 基础 坐标 系 的 位 置 由 向 量 


p.m (绝对 位 置 ) 


1 
P. =a (P +P) (29. 33) 


SS, 相对 于 基础 坐标 (绝对 方向 ) 的 方向 由 旋转 
SERE R, KIR 


R, =R, R' (Kl ,9,,/2) (29.34) 
单独 的 绝对 变量 不 能 唯一 地 描述 协同 操作 ， 如 一 
个 双 臂 系统 需要 12 个 变量 来 描述 。 因 此 ， 必 须 考虑 
每 个 机 械 手 相对 其 他 机 械 手 的 位 置 /方向 ， 以 完全 描 
述 系 统 的 状态 。 以 一 个 双 臂 系统 为 例 ， 机 械 手 之 间 的 
相对 位 置 为 


P. =P. -Pi (29. 35) 
两 个 工具 坐标 系 之 间 的 相对 方向 由 旋转 矩阵 
表示 


R! =R'R, =R} (29. 36) 
ABB p,, R,, p,, Rive XT PAE 2S fal, w 
JR, RAR) AHF Rs 和 R o 
值得 指出 的 是 ， 由 于 式 (29.33) ~ 式 (29.36) 
的 定义 不 基于 被 控 对 象 和 /或 抓 持 性 质 的 任何 特殊 假 
设 , 使 得 以 上 定义 的 协同 工作 空间 方程 具有 实用 性 。 
换 句 话说 ， 协 同 工 作 空间 的 变量 可 有 效 地 描述 合作 
系统 抓 持 非 刚 性 物体 和 /或 非 刚性 手 爪 抓 持 的 特性 ， 
也 可 描述 纯 运动 协调 任务 ， 如 机 械 手 不 与 普通 的 被 
控 对 象 产生 物理 接触 而 实现 的 协调 运动 。 当 机 械 手 
抓 持 一 个 刚性 物体 (或 者 一 个 形变 不 可 控 的 可 变形 
对 象 ) 时 ， 相 对 位 置 和 方向 是 保持 不 变 的 。 否 则 ， 
如 果 人 允许 (或 控制 末端 执行 器 间 的 相对 运动 ，R， 
All p. 可 能 会 根据 有 效 的 (可 控 的 ) 相对 运动 而 发 生 
改变 。 
根据 参考 文献 [29. 25，26 ] ， 可 知 绝对 线 速 度 
和 角速度 


= 


五 ,= 二 (有 + 万 ) w, m On e») 
(29.37) 
相对 线 速度 和 角速度 
p,-(p,-p,), w,-w,-w, (29.38) 
EIE, tn np IRER iz B3 26 SE EDU] A 
Sf, =f, thn, =n, +n, (29. 39) 


1 1 
f. =a -f,) ,n, = 本 (ma -n,) (29.40) 


同 理 ， 可 以 建立 线 / 角 速度 (73/7108) 与 每 个 
机 械 手 末端 执行 器 〈 或 关节 ) 0 070 对 应 点 之 间 的 动 
态 静 力学 映射 。 

显然 ， 根 据 相 似 的 映射 关系 可 知 ， 对 称 方程 及 任 
务 方程 中 的 变量 具有 相关 性 。 实 际 上 , 力 (角速度 ， 
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方向 变量 ) 在 两 个 方程 中 总 是 一 致 ， 而 上 只 有 将 被 控 
对 象 简化 为 一 点 ， 或 每 个 机 械 手 的 运动 学 是 相对 于 相 
应 虚拟 杆 硕 端 时 ,力矩 ( 线 速 度 和 位 置 变量 ) 才能 
满足 方程 。 

在 下 面 例子 中 ， 协 同 工 作 空间 的 变量 在 平面 合作 


系统 中 是 明确 的 。 
例 29.1 一 个 平面 的 双 臂 系统 的 协同 工作 空间 变量 


平面 双 辟 系统 第 i 个 工具 坐标 系 可 由 3 x1 列 向 


Bà 
Pi | . 
x;= , 1,2 


量 表 不 

AP, p, 是 第 i 个 工具 在 平面 上 的 2 x14 HIS e, 
是 方向 角 ( 即 工具 坐标 系 相对 于 平面 直角 坐标 轴 的 
转动 量 ) 。 因 此 ， 工 作 空 间 变 量 为 


x, =U, +X,) (29. 41) 
x, =X, —-X, (29. 42) 
EL — Ai SAAT i 83 23 18] AT A h — P Pc ff fr 9 B5 


表示 。 

在 空间 中 ,方向 变量 由 欧 拉 角 定义 ， 例 如 式 
(29.34) 和 式 (29.36) 中 的 一 些 主要 元 素 。 而 实际 
上 Si 和 ,一般 不 重合 ， 二 者 之 间 的 方向 偏 移 可 能 很 
大 ， 因 此 与 式 (29. 26) 类 似 的 定义 是 不 正确 的 。 因 
此 ， 必 须 采 用 几何 学 上 有 意义 的 方向 描述 ， 例 如 单位 
四 元 数 ( 见 第 1 章 )。 根 据 参 考 文献 [29.26] 中 的 
方法 ， 方 向 变量 可 以 定义 为 

1 1 9, po. [2 
Q, = 17, ,e, | = | cos 4 yk sin 4 } (29. 43) 
定义 单位 四 元 数 从 R' (ka, 0,72). 中 获得 ， 
Q = 1m ，el|、Q, = im, e} 分 别 表示 从 R, RP 
提取 的 单位 四 元 数 。 因 此 ， 绝 对 方向 可 以 表示 为 四 元 
数 相 乘 的 形式 


R, =R,R' (hy, ,0,,/2) 


Q, = \n,,e,| =Q, xQ; (29. 44) 
相对 方向 可 以 表示 为 四 元 数 相 乘 的 形式 : 
Q: - inse 2Qi' xQ (29. 45) 


AF, Q= im. el 
提取 的 单位 四 元 数 。 


29.4 动力 学 及 负载 分 配 


(HU Q, 693598). 代表 从 RI 中 


在 合作 操作 系统 中 ,第 i 个 机 械 手 的 动力 学 方程 
如 下 


M,(q;) q i *ei(q,,4;) -Ti -Ji(q)h, 
(29. 46) 


KP, MG) WIESE MPR BLEEDS e; (q, d) 
为 离心 力 、 科 氏 力 、 重 力 及 摩擦 力 所 产 生 的 力 / 力 算 
向 量 。 模 型 可 表示 成 如 下 的 紧凑 形式 
M(q)d *c(q,d) =T-J"(q)h (29.47) 

其 中 矩阵 为 块 对 角 阵 ， 如 M (g) = block diag 
|M,, M,| 和 向 量 组 , 如 4 = (好 他)7。 

物体 的 运动 可 根据 刚体 的 经 典 牛 顿 一 欧 拉 方 程 
获得 


M,(R,)v, cc, (R,,0,)v, =h; = Wh 
(29.48) 
式 中 ，M; 为 被 控 对 象 的 惯性 矩阵 ; cs 为 惯性 力 /力矩 
的 非 线 性 分 量 (如 重力 ， 离 心力 和 科 氏 力 的 力 / 
力矩 ) 。 
两 机 械 手 正常 操纵 刚体 时 的 运动 耦合 可 形成 封闭 
链 约 束 ， 该 约束 能 保证 上 述 公式 的 完整 性 。 可 在 映射 
方程 式 (29. 21) 中 添加 一 个 为 零 的 内 部 速度 矢量 来 
表示 约束 方程 
v= Viv, =V; -vs, =0 (29. 49) 
根据 式 (29.8) 和 式 (29.22), ， 上 式 可 由 末端 
执行 器 的 速度 (其 中 符号 WORE OW) 形式 
表示 


V'y - Wi ^v, - W; "v, =0 
由 关节 速度 形式 表示 如 下 

V'J(q)4 -W'J,(qd, qi = W;'J,(q,)d; =0 
(29.51) 
等 式 (29.47), xXX (29.48), xX (29.51) 
表示 协作 系统 在 关节 空间 的 约束 动力 学 模型 ， 根 
据 六 个 代数 封闭 链 约 束 式 (29.51), NM +N, X 
坐标 (如 gq, 和 gq,) 为 彼此 相关 的 。 它 表明 自由 度 
总 数 为 W +N, -6 且 模 型 具有 一 系列 的 微分 代数 


29.4.1 降 阶 模型 


将 上 述 推导 的 动力 学 模型 与 一 系列 闭 链 约束 方程 
结合 ， 独 立 的 广义 坐标 数 变 为 N, +N, -6 个 。 即 可 
通过 封闭 链 约束 方程 式 (29.51) 消 掉 六 个 等 式 ， 建 
立 降 阶 模 型 。 对 封闭 链 约 束 建 立 降 阶 方程 的 早期 研究 
可 见 参 考 文献 [29. 58 ]。 后 期 的 研究 见 参 考 文献 
[29. 59，60] ,根据 式 (29.47)、 式 (29.48) AX 
(29. 51) ， 通 过 推导 整个 封闭 链 系 统 关 节 空 间 模型 可 
以 解决 该 问题 

M.(q) q *cc(q,4) -D.(q)t (29.52) 
WP, Me, Co, DAOR TULI FAI AE TE XT 8 B5 oh 


(29. 50) 
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力学 特性 以 及 抓 持 动 作 的 几何 特性 。 已 知 关节 力 
EET (固定 的 采样 时 间 )， 可 求 取 关节 变量 4q 
(IEMA). AT (N,+N,) x CN, € N) 和 矩阵 
D FEAR ERP) ， 因 此 模型 不 能 用 来 从 指定 的 
q, q 和 9 ( 逆 动 力学 ) 求 取 z， 即 不 可 求解 逆 动 
力学 问题 。 
为 找到 有 N, + N, -6 个 等 式 的 降 阶 模型 ， 必 须 
考虑 (N, +N, -6) x1 HEEE 
y - B(q)q (29.53) 
st, B (4) 为 ((N, +N, -6) x (N, € N)) 36 
阵 , 因此 (4 (4) B' (q)) 为 非 奇 异 阵 且 满足 
A(q) WV (q). 
因此 ， 可 令 g、v、v 为 变量 建立 降 阶 模型 : 
ZX'(q)Mc(q) X(aq) » +3" (q)ey(q,v) - Y (q)t 
(29. 54) 
式 中 , XH ((N, +N, -6) x(N,+N,)) HB, H 


满足 
^Y Lan s 
(5) -ür 3 


cn 取决 于 cv 、 卫 及 76 ， 利 用 降 阶 模型 可 求 
解 正 动力 学 。 因 此 ， 必 须 考 虑 数值 积分 中 与 ”相关 的 
一 系列 伪 坐 标的 表达 方式 。 由 于 X 为 非 奇异 阵 ， 因 
此 逆 动 力学 有 无 穷 多 个 解 ， 但 这 并 不 影响 模型 式 
(29.54) 应 用 于 合作 机 械 手 的 控制 (如 参考 文献 
[29.59, 60]) “PRY AR REL HI) 。 


负载 分 配 


由 于 多 手臂 系统 有 宛 余 的 致 动 器 ， 因 此 ， 多 
辟 机 器 人 系统 的 负载 分 配 问 题 主要 是 机 械 手 之 间 
的 负载 分 配 问题 (如 能 力 强 的 手臂 承担 的 负载 多 
于 弱 的 手臂 ) 。 如 果 机 器 人 手臂 致 动 器 的 数目 与 支 
撑 负 载 所 需 数目 一 致 ， 则 不 能 优化 负载 的 分 配 ， 
对 于 这 种 情况 可 见 参考 文献 [29.35-41] 的 研究 
结果 。 
可 以 采用 负载 分 配 矩 阵 来 描述 合作 机 械 手 的 运动 
学 ， 以 适当 的 广义 逆 we 代替 等 式 (29.11) 的 广义 
闭 ， 可 得 虚拟 杆 顶 端的 广义 力 
hs =W; h; +V<h' 


LY 
I, -L 


JERE L HRR, RAR TE, EE L 
的 非 对 角 元 素 仅 零 空间 W, BAH JER HHE 
^r hh. D, ABE, CL 


29. 4. 2 


(29. 55) 


(29. 56) 


L = diag| A} (29.57) 
XP, BEA, 8, Ag)", A 为 负载 分 配 
系数 。 
适当 的 调整 负载 分 配 系数 可 确保 机 械 手 合作 的 准 
确 性 。 为 解决 该 问题 ， 将 式 (29.11) 及 式 (29.55) 
合并 可 得 


h, - V.(W; -W.h, +h! (29. 58) 

考虑 到 只 有 hy, BANS FEE ih, W: 

1) hi, h, MUI EIS REAR, UEA XR 
操作 过 程 。 

2) 1i 及 入 不 互相 独立 ， 内 力 / 力 和 抢 及 负载 分 配 
概念 在 数学 上 相互 耦合 。 

因此 ， 从 数学 公式 看 ， 调 整 负载 分 配 系数 与 选择 
合适 的 内 力 /力矩 是 完全 等 价 的 (包括 表达 方式 )。 
HPA 、 太 及 从 中 只 有 一 个 变量 是 独立 的 ， 因 此 可 
利用 他 们 中 的 元 余 参 数 来 优化 负载 的 分 配 ， 该 方法 始 
于 参考 文献 【29.38，39 ] 。 在 参考 文献 [29.41] 
中 ， 调 整 内 力 /力矩 六 以 实现 控制 算法 的 简化 及 一 
致 性 。 

与 负载 分 配 十 分 相关 的 一 个 问题 为 抓 持 作 业 的 鲁 
棒 性 ， 即 如 何 确定 手臂 作用 于 被 控 对 象 的 力 /力矩 
hs， 以 保证 即使 受到 外 力 / 力 矩 时 也 能 平稳 地 抓 持 物 
体 ， 通过 调整 内 力 /力矩 (调整 负载 分 配 系 数 ) 可 以 
解决 该 问题 。 正 如 参考 文献 [29.40] 所 述 ， 可 由 末 
端 执行 器 的 力 /力矩 确定 抓 持 的 条 件 ， 换 句 话 说 ,将 
式 (29.55) 中 代入 抓 持 条 件 方 程 ， 可 获得 关于 hi 
及 和 的 线性 不 等 式 

A,h! +B,À <c, (29. 59) 
XUP, AQR B, X 6x6 HERE, cj 为 6x1l RE, TE 
参考 文献 [29.40] 中 ， 可 启发 式 地 得 到 线性 不 
等 式 的 解 和 A。 上述 不 等 式 可 以 变换 为 关于 的 其 
他 不 等 式 ， 由 于 入 可 直观 理解 ， 它 适用 于 启发 式 算 
法 ,可 以 通过 引入 优化 目标 函数 ， 以 数学 方法 解 
决 该 问题 。 因 此 选择 希望 被 优化 的 的 二 次 成 本 
函数 


LT 


f - high, (29. 60) 
式 中 ，@ 为 6x6 维 正 定 和 矩阵 。 该 函数 可 以 看 做 关节 
致 动 器 的 能 量 消耗 ， 如 机 械 手 在 致 动 器 消耗 的 电能 转 
换 为 力 /力矩 h!。 根 据 参 考 文献 [29. 41 ] ， 可 以 求 得 
二 次 方程 式 (29. 60) 的 解 。 
对 多 手指 机 械 手 抓 持 过 程 中 鲁 棱 性 的 深入 研究 可 
见 第 28 章 。 
参考 文献 [29.36] 利用 机 械 手 关节 空间 的 动力 
学 阐述 了 负载 的 分 配 问 题 ， 直 接 通过 关节 致 动 器 力矩 
来 描述 负载 的 分 配 。 同 理 ， 可 以 利用 不 同 子 任务 的 性 
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能 指标 来 求解 元 余 机 械 手 的 逆 动 力学 ， 以 解决 负载 分 
配 问题 。 


29.5 工作 空间 分 析 


与 分 析 单 臂 机 器 人 系统 类 似 ， 定义 合适 的 可 
操作 性 椭 球 来 评价 操作 空间 成 为 研究 合作 作业 的 
重要 问题 ， 参 考 文献 [29.30] 已 将 这 些 概念 应 用 
于 多 臂 机 器 人 。 根据 29.3 节 的 动态 静 力 学 公式 ， 
将 整个 合作 系统 看 作 从 关节 空间 到 作业 空间 的 机 


受 力 和 绝对 运动 的 控制 成 为 研究 重点 。 合 作 机 器 人 系 
统 的 主要 控制 方式 可 分 为 力 /运动 控制 ， 运 动 控 制 环 
主要 跟踪 期 望 物体 的 运动 ， 力 控制 环 主要 控制 负载 的 
受 力 情况 。 
早期 对 合作 机 械 手 控 制 系统 的 研究 主要 基于 主 从 
控制 方式 ， 因 此 合作 系统 可 分 为 : 
1) 主动 手 辟 控制 被 控 对 象 的 绝对 运动 。 对 主动 
手臂 进行 位 置 控制 以 实现 准确 、 稳 定 的 参考 轨迹 位 置 
及 方向 跟踪 。 换 言 之 ， 面 对 外 部 干扰 (与 其 他 合作 
机 械 手 的 交互 接触 力 ) ， 通 过 控制 主动 手臂 的 运动 来 


械 传递 器 ， 定 义 速度 和 力 的 可 操作 性 覃 球 。 由 于 
构成 力 / 速 度 的 椭 球 包含 非 齐 次 量 (如 力 及 力矩 ， 
线 速度 及 角速度 ) ， 因 此 必须 特别 注意 这 些 概 念 的 
EI) | 同时 ， 由 于 椭 球 包含 内 力 ， 因 此 
将 内 力 的 物理 意义 参数 化 是 很 重要 的 问题 ， 如 参 
考 文献 [29.15, 16]. 

根据 参考 文献 [29.30] 的 方法 ， 外 力 可 操作 性 
椭 球 可 由 下 面 标量 方程 描述 

hi (J,JL)h, =1 (29. 61) 

RP, J, 2W'" J。 外 部 速度 可 操作 性 椭 球 可 由 下 面 
标量 方程 描述 


| (29. 62) 
在 双 辟 系统 中 ， 内 力 可 操作 性 椭 球 定义 如 下 : 
hi (J.J, )h, =1 (29. 63) 
式 中 , J, = VJ. 根据 动态 静 力 学 的 对 偶 性 ， 内 部 速 
度 可 操作 椭 球 定义 如 下 
vi(JJi) v=1 (29. 64) 
当 每 次 考虑 一 对 相互 影响 的 末端 执行 器 时 ' 人 3 ， 
在 包含 两 个 以 上 操作 臂 的 合作 系统 中 可 以 定义 内 力 / 
速度 椭 球 。 
在 指定 的 系统 中 ， 可 操作 椭 球 可 以 作为 检测 机 械 
手 合作 效果 的 度量 指标 。 同 样 ， 就 单 臂 操作 系统 而 
言 ， 可 操作 椭 球 可 用 来 确定 匈 余 多 手臂 系统 的 最 佳 


除 此 之 外 ,研究 人 员 还 提出 了 男 外 两 种 方法 来 
分 析 多 手臂 合作 系统 的 可 操作 性 。 面 向 任务 的 可 操 
作 性 测量 ”和 多 面体 ””。 此 外 ,参考 文献 
[29.33] 提出 了 多 手臂 操作 系统 动力 学 分 析 的 系统 
方法 ， 即 将 动力 学 可 操作 性 椭 球 应 用 于 多 手臂 操作 
系统 中 ， 研 究 控制 被 控 对 象 治 工作 空间 方向 加 速 的 


ab 
HE 7J o 


29.6 控制 


利用 多 机 械 臂 合作 系统 抓 持 物体 时 ， 对 被 控 对 象 


实现 其 准确 的 运动 。 

2) 对 从 动手 臂 进行 力 控制 以 实现 交互 力作 用 下 
的 柔顺 性 ， 期 望 从 动手 臂 能 够 尽 可 能 平滑 地 跟踪 主动 
手臂 运动 。 

上 述 方法 称 为 主 从 控制 ”3， 它 根据 封闭 链 约 
束 条 件 计算 从 动手 臂 的 参考 运动 。 

由 于 从 动手 辟 必 须 非常 柔顺 才能 够 平滑 的 跟踪 主 
动手 臂 的 运动 ， 因 此 该 方法 的 实现 有 一 定 困难 。 在 工 
作 过 程 中 ， 主 从 机 械 手 模型 需要 产生 动力 学 变化 ， 因 
此 ， 对 于 一 个 给 定 的 作业 任务 ， 如 何 分 配 主 从 机 械 手 


因此 ， 随 后 提出 的 非 主 从 控制 将 合作 系统 作为 
一 个 整体 来 考虑 ， 根 据 被 控 对 象 的 参考 轨迹 确定 系 
统 中 所 有 机 械 手 的 运动 ， 并 将 每 个 末端 执行 器 的 受 
力作 为 反馈 直接 控制 。 为 实现 该 控制 策略 ， 在 控制 
顺 设 计时 ， 需 要 考虑 每 个 机 械 手 末 端 执行 器 的 速度 
和 力 之 间 的 映射 关系 以 及 他 们 在 被 控 对 象 上 的 仿 


移 量 。 


29. 6.1 


混合 控制 


基于 Raibert 和 Craig 提出 的 单 臂 系统 的 机 器 人 / 
环境 交互 控制 方法 ,参考 文献 [29.11, 12] 提出 了 
一 种 非 主 从 控制 方式 (第 7 章 ) ， 力 /位 混合 控制 ， 
其 操作 空间 向 量 如 下 


N 
Xo = 

X 

式 中 , x, x JIA B 7r el fü e 4 
定 的 工作 空间 向 量 。 广 义 力 向 量 为 


四 

hy = 

h, 
控制 框图 如 图 29.2 所 示 ， 下 标 4 和 nm 分 别 表示 

期 望 值 以 及 控制 器 输出 。 两 机 械 手 致 动 器 的 控制 力 拖 


Tn 为 


(29. 65) 


(如 欧 拉 角 ) 确 


“uy 


(29. 66) 


Tm =Tp + Th (29. 67) 
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COVER EN 1 
l,d Xa TAR Ard 29. 72 
= K,J5'G,(s)SB(x5y—%5) (29.68) E M M e 
ra ORL xu =x) Faa) (29.73) 


Th =K,JSG,(s) (1-8) (hoa -h,) (29.69) 
矩阵 B 将 方向 角 误 差 转 换 成 等 价 的 转动 向 量 。 


J 为 雅 可 比 和 矩阵 ， 可 将 关节 空间 速度 gg 变 成 工作 空 
HERBE vo, HERE Gy (s) AIG, (s) 分 别 代 表 位 置 和 


力 的 控制 律 。 增 益 矩 阵 K、 及 Ki, 为 对 角 线 阵 ， 其 对 角 
线 元 素 分 别 将 力 /速度 控制 量变 成 致 动 器 控制 量 。 算 
EE S 包含 位 置 控制 变量 ， 该 矩阵 为 对 角 线 元 素 是 0 或 
1 的 对 角 阵 ， 如 果 S 的 第 i 个 元 素 为 1， 则 代表 第 i 个 
工作 空间 坐标 系 满足 位 置 控制 ， 当 第 i 个 元 素 为 0 时 
满足 力 控制 。7 为 单位 阵 ， 与 S 维 数 相同 。qg RA 


别 代表 传 感 咒 检测 到 的 关节 变量 向 量 和 来 端 执行 器 的 
广义 力 。 


图 29. 2 力 / 位 混合 控制 框图 


29.62 PD 力 / 位 控制 


参考 文献 【29. 17] 中 基于 李 雅 普 诺 夫 函数 推导 
了 力 / 位 PD 控制 器 。 每 个 机 械 手 的 关节 力矩 输入 由 
两 部 分 组 成 


Tm 2T, + Ti (29. 70) 


空间 范围 内 必须 使 用 有 几何 意义 的 量 来 表示 绝对 
及 相对 方向 (如 式 (29.44) 和 式 (29.45)), ， 因 此 ， 
式 (29.72) 和 式 (29.73) 不 满足 空间 范围 的 要 求 。 
可 使 用 一 个 稍微 复杂 的 形式 表示 上 式 ， 以 获得 同样 的 
结果 [2 l 
ee DUET S HB i AY m], ET A 
根据 逆 运 动 学 求 得 每 个 关节 的 期 望 轨迹 qu, JP qu 
作为 控制 量 。 因 此 ， 需 要 推导 很 多 闭 运 动 学 公式 
(第 1 章 及 11 章 ) 。 
也 可 以 用 末端 执行 器 变量 设计 PD 控制 器 
T,-J'(K,e- Kv») -Kq «^g J' Weg, 
(29. 74) 
RP, e 为 末端 执行 器 的 位 置 /方向 跟踪 误差 ; v ON 
未 端 执行 器 的 速度 ; Kp, Ky & K, 为 正定 增益 
和 矩阵。 
同 理 也 可 以 利用 被 控 对 象 变量 设计 PD 控制 器 
T, -J'W'(K,e; —K,v,) -Kaq +g +J' W's, 
(29. 75) 
式 中 ， ee ing eae 生得 到 
的 跟踪 误差 ; vj 为 被 控 对 象 的 广义 速度 变量 ，K,、 
ee e 
可 以 用 下 式 代 替 内 力 控 制 
zJ'Vh,. (29. 76) 
h. =h,,+G,(s)(h,y-h,) — (29.77) 
G(s) 为 有 线性 滤波 器 功能 的 矩阵 操作 项 ， 以 
MII-G, RHA ERNE, h, oo eee 


AF, TA PD 位 置 控制 输出 〈 主 要 为 基于 模型 的 前 
馈 / 反 馈 的 补偿 项 ) ; THETA I/F HE 

在 关节 空间 计算 可 得 T， 

T, = Kpe, -Kq +g¢+J'W'2, (29.71) 

式 中 ,，e, =q4 -9，44 为 期 望 关 节 位 置 向 量 ; Kp, Ka 
为 正定 增益 矩阵 ; g 为 重力 在 关节 空间 的 力 / 力 短 ， 
gE 为 作用 于 被 控 对 象 的 重力 /力矩 。 
由 于 合作 任务 经 常 以 绝对 运动 或 相对 运动 来 分 
配 ， 因 此 ， 运 用 封闭 链 约 束 方 程 可 计算 末端 执行 器 的 
等 效 期 望 轨迹 ， 例 子 如 下 。 
$129.2 ”计算 平面 双 臂 系统 的 期 望 轨迹 

利用 绝对 运动 量 x, ,及 相对 运动 量 x, ,描述 合作 
任务 的 期 望 轨迹 。 因 此 ， 由 式 (29.41) KA 
(29.42) 可 知 末端 执行 器 的 期 望 运动 轨迹 


量 , 根据 末端 执行 右 的 受 力 可 计算 得 到 内 力 hh = 
V'h。 为 使 稳 态 误差 为 零 ， 可 令 G,(s) 为 


1 
G, (s) = — 


式 中 ，K 为 正定 和 矩阵。 显然 ， 当 抓 持 刚性 物体 时 ， 
为 保证 系统 的 稳定 性 ， 需 使 用 滤波 器 对 力 误差 进行 预 
处 理学 1。 例 如 ， 如 果 取 简单 的 线性 反馈 G, (s) = 
及 ， 由 于 存在 一 个 任意 小 的 时 延 ， 因 此 需要 选择 一 
个 小 于 1 的 力 系 数 ， 否 则 闭环 系统 不 会 稳定 。 实 际 
上 ， 运 动 闭环 具有 一 定 的 弹性 (如 抓 持 手 扑 ,末端 
执行 器 的 力 / 力 和 矩 传感器 ， 关 节 等 )， 因 此 必须 令 控 
制 系数 及, 与 弹性 元 件 刚度 的 乘积 足够 小 ， 以 保证 系 
统 稳定 。 

参考 文献 [29.26, 28] 对 上 述 方法 进行 了 扩 
展 ， 实 现 对 控制 过 程 的 动态 静 力 学 滤波 ， 以 滤 掉 所 有 


一 
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对 被 控 对 象 产生 内 力 的 控制 输入 。 即 根据 滤波 后 的 加 
权 比 例 系 数 (天 ,e,) ， 可 修改 控制 规律 式 (29.71) : 
e-J'(WW-«VXy»J^* 

式 中 ，6 x6 对 角 和 矩阵 了 = diag|o,|， 取 0<o,<1 为 
常 值 ， 代 表 了 .7 Ke, 在 内 力 子 空间 的 每 个 方向 上 的 
成 分 。 当 = O06 时 ， 所 有 控制 器 不 起 作用 4 Y=I, 
时 ， 选 择 不 带动 态 静 力学 滤波 器 的 控制 器 式 (29.71) 。 
同 理 ， 分 别 选 用 正确 的 动态 静 力 学 滤波 器 Re 及 Ke, 

可 修改 控制 规律 式 (29.74) 和 式 (29.75). 


29.6.3 ”线性 反馈 方法 


引入 完整 模型 的 补偿 可 实现 PD 重力 补偿 控 
制 ， 即 实现 闭环 系统 的 线性 反馈 /前 馈 。 操 作 空间 
的 线性 反馈 补偿 是 所 谓 的 增强 对 象 法 (augmented 
object approach) 的 基础 ”中 。 该 控制 方法 中 ， 
在 工作 空间 中 将 系统 作为 一 个 整体 进行 建 模 ， 通 
过 一 个 单独 的 增 广 惯 性 矩阵 Mu 适当 地 表达 系统 的 
惯性 特性 。 因 此 ， 合作 系 统 在 操作 空间 的 动力 学 
模型 为 


Mo(xe) XE $05 (Rete) =h; (29. 78) 
式 中 ，M。 和 ec6 为 操作 空间 模型 ,分别 代表 系统 GN 
作 辟 及 被 控 对 象 ) 的 惯性 特征 和 科 氏 力 、 离 心力 、 
摩擦 力 及 重力 项 。 
根据 参考 文献 [29. 16] 中 的 虚拟 杆 模 型 及 参考 

文献 [29.29] 中 的 方案 ,可 以 解决 在 线性 反馈 中 
(操作 空间 范围 内 ) 的 内 力 控制 问题 。 
T=J'W'[M,(¥ pa +K, ep *K,e,) +00] 4 

J'V(h,, + KS (hia -h)) (29. 79) 
上 述 模型 产生 了 一 个 线性 解 耦 的 闭环 动力 学 方程 

e +K e, * K,e, =0 


z 


h,* K,| hd =0 (29. 80) 


RP, h =h,, -h,, BIETEN AS HIRE 
渐 近 消失 。 


29.6.4 阻抗 控制 


根据 已 知 的 阻抗 控制 概念 〈 第 7 章 ) ， 提 出 一 种 
新 的 控制 方法 。 事 实 上 ， 在 满足 机 器 人 系统 动力 学 特 
性 的 条 件 下 ， 当 作业 系统 中 的 机 械 手 与 环境 或 与 其 他 
机 械 手 接触 时 ， 和 柔顺 运动 可 以 避免 大 的 接触 力 或 者 位 
移 。 因 此 ， 提 出 了 柔顺 控制 方法 来 控制 合作 系统 中 被 
控 对 象 /环境 间 的 过 大 的 接触 力 拉 2 809977777, RE 
近 ， 参 考 文献 【29.65] 提出 了 一 种 控制 外 力 和 内 力 
的 柔顺 控制 方法 。 


为 保证 被 控 对 象 的 位 移 和 环境 与 被 控 对 象 的 受 力 
间 存 在 阻抗 关系 ， 参 考 文献 [29.21] 提出 了 如 下 阻 
抗 控制 方法 
M,a@,+D,¥, * K,e, =h,,, (29. 81) 
AP, e 2 MESS Se HIER (v ES SER EE v. 
为 被 控 对 象 期 望 速度 和 实际 广义 速度 之 差 ; a hdd 
对 象 的 期 望 加 速度 和 实际 广义 加 速度 之 差 ; hh 为 环 
境 作 用 于 被 控 对 象 的 广义 力 ; Me AREE; D; 为 
刚度 矩阵 ; 阻尼 矩阵 Ki 表示 系统 的 阻抗 特性 。 选 择 
合适 的 特性 矩阵 能 够 使 被 控 对 象 实现 期 望 的 运动 。 与 
式 (29.81) 中 位 置 误差 类 似 ， 也 要 考虑 转角 变量 。 
例 29.3 两 手臂 系统 的 外 阻抗 
式 (29.81) 中 平面 双 臂 操纵 系统 的 变量 可 以 直 
接 定义 如 下 


€; =XP a Xg (29. 82) 
P; —Xga-Xy (29. 83) 
r= Xna Ke (29. 84) 


式 中 ，xs 为 被 控 对 象 的 方向 和 位 置 3 x 1 向 量 ; xy ,为 
期 望 位置 ; Mi 、D; 、K; 分 别 表示 3 x3 和 矩阵。 

对 于 空间 机 器 人 系统 内 ， 不 能 像 式 (29.82) 中 
那样 定义 方向 误差 ， ner DE e 
示 法 (旋转 矩阵 或 转角 /坐标 轴 ) 及 操作 空间 变 
(如 操作 空间 向 量 之 间 的 偏差 ) 来 定义 1。 

在 参考 文献 [29.22] 提出 的 阻抗 控制 器 中 ， 令 
第 ;个 末端 执行 器 的 位 移 及 内 力 之 间 满 足 机 械 阻 抗 
特性 


M,,4,+D,,¥,+K,,e,=h,, — (29.85) 
式 中 ，e; 为 第 ;个 末端 执行 器 期 望 位 置 与 实际 位 置 之 
差 ; ?7 ;为 第 ;个 末端 执行 器 期 望 和 实际 速度 之 差 ; a 
为 第 i 个 末端 执行 器 期 望 和 实际 加 速度 之 差 ; hy ;为 
第 i 个 末端 执行 器 的 内 力 ， 如 向 量 VV'h 的 第 i 个 组 
成 部 分 。 在 内 力作 用 下 ， 适 当地 选择 影响 阻抗 动态 特 
性 的 正定 惯量 阵 M. BERE D, ;和 刚度 阵 K, P 
以 使 系统 实现 期 望 的 阻抗 运动 。 
例 29.4 平面 双 辟 操纵 系统 的 内 部 阻抗 
式 (29.85) 中 平面 双 臂 操纵 系统 的 变量 可 以 直 


接 定 义 如 下 
e; 2X;4 —Xj (29. 86) 
säat, (29. 87) 
á,- X, - X, (29.88) 


RP, x ,为 末端 执行 器 的 位 置 和 方向 角度 的 3 x1 向 
量 ; x; ,为 第 i 个 末端 执行 器 的 期 望 位 置 及 方向 向 量 ; 
Mi;、Di,、Ki ,为 3 x1 和 矩阵。 


liz 
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对 于 空间 情况 ， 不 能 像 式 (29.86) 那样 定义 
x (29.85) 所 描述 的 方向 误差 ， 需 利用 具有 几何 
意义 的 方向 表示 法 (旋转 矩阵 或 转角 /坐标 轴 ) 及 
操作 空间 变量 ( 如 操作 空间 向 量 之 间 的 偏差 ) 来 
JEU. 

参考 文献 【29. 65] 已 将 上 述 两 种 方法 合并 ， 利 
用 双 闭 环 以 实现 被 控 对 象 (外 力 ) 及 末端 执行 器 
(内 力 ) 的 阻抗 运动 。 


结论 与 扩展 阅读 


本 章 曾 述 了 合作 机 械 手 的 基本 操作 内 容 ， 回 
顾 了 合作 机 械 手 的 发 展 历 史 ; 分 析 了 合作 机 械 手 
抓 持 刚 性 物体 的 运动 学 及 动力 学 特性 ; 研究 了 合 
作 工 作 空 间 的 定义 及 负载 分 配 等 专业 问题 ; 最 后 
探讨 了 合作 作业 系统 的 主要 控制 方法 、 合 作 机 械 
手 的 先进 控制 方法 ， 如 基于 模型 的 先进 非 线性 控 
制 及 有 弹性 元 件 的 合作 系统 的 控制 等 ， 将 在 下 面 
进行 简要 的 介绍 。 

为 克服 合作 机 械 手 系统 的 不 确定 性 及 扰动 ， 在 参 

考 文献 [29.23, 24] 中 ,使 用 了 自 适 应 控制 策略 ， 
基于 不 确定 性 模型 的 线性 参数 ， 在 线 估 计 不 确定 性 参 
数 。 人 参考 文献 [29.23] 提出 的 方法 主要 控制 被 控 对 
象 的 运动 、 机 械 手 与 被 控 对 象 /环境 之 间 的 接触 力 及 
内 力 ; 自 适应 控制 策略 基于 误差 方程 估计 操作 辟 和 物 
体 的 未 知 参数 。 参 考 文 献 [29.24] 提出 用 于 设计 分 
散 模块 的 自 适 应 控制 策略 ， 如 元 余 合作 系统 不 使 用 中 
央 控 制 器 。 
最 新 提出 的 合作 机 器 人 控制 方法 ， 称 之 为 同步 控 
HAP) ， 该 方法 根据 合作 操作 系统 中 机 械 手 的 协 
调运 动 误差 制订 控制 策略 。 参 考 文献 [29.49] 的 主 
要 控制 思想 是 确保 每 个 机 械 臂 跟随 期 望 运动 轨迹 ， 保 
持 与 其 他 操作 辟 的 同步 运动 。 参 考 文献 [29. 50] 提 
出 了 一 种 解决 多 辟 系 统 运动 同步 性 的 方法 。 为 测量 机 
械 手 的 位 置 ， 同 步 控制 器 包含 反馈 项 及 非 线性 观测 
器 ， 通 过 适当 的 定义 机 械 手 运动 过 程 的 耦合 误差 实现 
同步 控制 。 

近年 来 ， 各 国学 者 对 智能 控制 进行 了 大 量 研 
ap95 参考 文献 [29.51] 提出 了 基于 运动 H, 
及 内 力 跟踪 的 半分 散 自 适应 模糊 控制 策略 ， 每 个 机 咒 
人 的 控制 器 包含 两 部 分 : 基于 模型 的 自 适 应 控制 器 和 
自 适 应 模糊 逻辑 控制 器 。 基 于 模型 的 自 适 应 控制 器 处 
理 包含 纯粹 的 参数 不 确定 性 动力 学 模型 ， 自 适应 模糊 
逻辑 控制 器 处 理 非 结构 不 确定 性 和 外 部 扰动 产生 的 影 
响 。 参 考 文献 [29.52] 提出 了 分 散 自 适应 模糊 控制 
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策略 ， 利 用 多 输入 多 输出 模糊 逻辑 控制 思想 及 系统 在 
线 自 适应 机 制 制订 控制 策略 。 

最 后 值得 一 提 的 是 利用 局 部 状态 反馈 提出 的 控制 
策略 ， 例 如 只 有 关节 位 置 和 来 端 执行 器 的 力作 为 控制 
器 的 反馈 。 最 新 的 研究 成 果 是 参考 文献 [29.53] 提 
出 的 分 散 控制 算法 ， 使 用 非 线性 速度 观测 器 实现 渐 近 
地 跟踪 期 望 的 力 和 位 置 。 

当 使 用 非 刚性 手 爪 抓 持 物体 时 ， 合 作 系统 可 能 产 
生 弹 性 变形 。 事 实 上， 采用 柔性 手 爪 可 避免 大 的 内 
力 ， 即 使 抓 持 失败 或 与 环境 产生 的 非 预期 性 接触 ， 也 
可 以 保证 操作 的 安全 。 参 考 文献 【29.57] 提出 了 不 
基于 模型 的 离散 控制 方法 ， 即 具有 重力 补偿 项 的 PD 
位 置 反馈 控制 策略 。 该 策略 能 够 规范 被 控 对 象 的 位 置 
/方向 ， 同 时 实现 由 柔顺 手 爪 引起 的 振动 阻尼 。 当 抓 
持 手 爪 的 柔顺 性 太 低 而 不 能 保证 对 被 控 对 象 施加 有 限 
的 内 力 时 ， 则 采用 混合 控制 方法 控制 沿 着 位 置 方向 的 
内 力 。 

其 他 研究 主要 集中 于 抓 持 多 个 物体 和 和 柔性 对 
象 .4 。 由 于 这 些 对 象 难 以 控制 ， 在 制造 业 中 很 
难 实现 装配 的 自动 化 。 因 此 ， 对 具有 多 个 柔性 机 械 
辟 合 作 机 器 人 的 控制 技术 进行 了 研究 ， 一 旦 解决 了 
建 模 和 控制 问题 ( 见 第 13 章 ) ， 柔 性 机 器 人 将 具 
很 多 优点 : 重量 轻 ， 具 有 和 柔顺 性 ， 且 安全 性 好 。 将 
柔性 臂 的 控制 方法 〈 如 振动 抑制 ) 与 本 章 提 出 的 合 
作 机 械 手 控制 方法 结合 是 容易 的 ”1。 参 考 文 献 
[29.46] 已 经 开始 了 对 双 柔 性 机 械 手 机 器 人 自动 检 
测 操 作 的 研究 。 
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王 奇 志 


触觉 学 (Haptics) 一 词 ， 应 源 自 于 希腊 文 
haptesthai， 意 指 关 于 接触 感知 的 知识 。 在 心理 学 和 
神经 科学 的 文献 中 ， 和 触觉 学 研究 的 是 人 类 对 于 接触 
的 感知 ， 特 别 是 通过 运动 〈 力 /位 置 ) 和 皮肤 ( 接 
触 ) 感受 器 并 与 感知 和 操纵 相关 的 触觉 。 在 机 器 人 
和 虚拟 现实 文献 中 ， 触 觉 学 被 广义 地 定义 为 机 带 人 
或 人 类 与 现实 环境 、 远 程 环 境 或 模拟 环境 之 间 的 真 
实 的 或 模拟 的 接触 互动 ， 或 者 上 述 场景 的 组 合 。 本 
章 把 重点 放 在 特殊 机 器 人 装置 的 使 用 及 其 相应 的 控 
制 ， 即 触觉 界面 技术 ， 这 些 技术 人 允许 人 类 操作 者 可 
以 在 远程 环境 〈 遥 控 操 作 或 远程 操作 ) 或 模拟 
(虚拟 ) 环境 中 体验 触觉 。 
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由 于 依赖 灵巧 的 机 电 设备 并 且 还 广泛 应 用 了 机 械 
手 设计 、 驱 动 、 传 感 及 控制 的 理论 基础 ， 触 觉 技术 与 
机 器 人 技术 密切 联系 。 在 本 章 中 ， 我 们 将 首先 介绍 触 
觉 界面 设计 和 使 用 的 目的 ， 其 中 包括 触觉 界面 的 基本 
设计 、 人 体 触觉 信息 以 及 触觉 界面 的 应 用 实例 。 其 
次 ,我 们 将 回顾 运动 触觉 界面 的 机 电 设计 的 有 关 概 
念 ， 包 括 传 感 顺 、 执 行 器 和 机 构 。 然 后 ， 我 们 回顾 动 
觉 的 触觉 界面 的 控制 方面 ， 尤 其 是 虚拟 环境 模拟 及 力 
的 稳定 和 精确 显示 。 接 下 来 ， 我 们 将 回顾 触觉 显示 方 
法 ， 由 于 需要 呈现 各 种 各 样 的 触觉 信息 给 人 类 操作 
者 ， 这 些 方法 变化 纷呈 。 最 后 ， 我 们 提供 了 进一步 研 
究 触 觉 技 术 的 文献 。 


30.1 概述 


触觉 学 是 在 人 为 控制 条 件 下 体验 和 产生 触摸 感觉 
的 科学 和 技术 。 设 想 如 果 没 有 触觉 ， 我 们 将 如 何 扣 上 
大 衣 上 的 纽扣 ， 和 他 人 握手 , 或 者 写 一 张 便条 。 如 
果 没 有 足够 的 触觉 反馈 ， 这些 简单 的 任务 变 得 难以 
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完成 。 为 了 提升 人 类 操作 者 在 模拟 环境 或 远程 操作 
环境 中 的 操作 水 平 ， 触 觉 界面 (技术 ) 寻求 产生 一 
种 赋予 性 的 感觉 信号 使 得 操作 者 感到 真实 环境 触摸 
可 及 。 

触觉 界面 ， 试 图 通过 机 械 电 子 设 备 和 计算 机 控制 
技术 再 现 或 强化 操纵 或 感知 真实 环境 的 触觉 体验 。 它 
们 包括 一 个 触觉 装置 (具有 传感器 和 执行 器 的 操作 
Bids) 和 一 个 控制 计算 机 ， 该 控制 计算 机 装 有 能 
够 将 相关 人 类 操作 输入 给 触觉 信息 显示 的 软件 。 而 触 
觉 界面 的 低层 设计 根据 不 同 的 应 用 广泛 地 变化 ， 他 们 
的 操作 一 般 情况 下 遵守 触觉 循环 ， 如 图 30.1 Pras. 
首先 ， 触觉 设 备 检测 到 一 个 操作 输入 ， 这 可 能 是 位 置 
(及 其 各 阶 微分 )、 力 、 肌 肉 的 活动 等 。 其 次 , 传 感 
的 输入 被 施加 到 一 个 虚拟 的 或 遥 操 作 环境 中 。 对 于 一 
个 虚拟 环境 ， 操 作者 的 输入 对 虚拟 物体 施加 的 影响 以 
及 随后 响应 显示 给 操作 者 ， 这 些 计算 都 是 基于 模型 和 
触觉 再 现 算法 。 在 遥 操 作 中 ， 一 个 机 械 手 在 空间 、 尺 
度 、 或 能 量 方面 都 是 远程 的 ， 它 将 试图 跟踪 远程 操作 
者 的 输入 。 当 机 械 手 与 其 真实 环境 互动 时 ， 需 要 传递 
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给 操作 者 的 触觉 信息 将 得 到 记录 和 评估 。 最 终 ， 触 觉 
装置 的 执行 器 会 将 触摸 感觉 完全 地 传递 给 人 类 操作 
者 。 无 论 是 通过 无 意识 或 有 意识 人 类 控制 ， 或 简单 的 
系统 动力 学 ， 基 于 触觉 的 反馈 都 改变 了 操作 者 的 输 
和信。 这 将 开始 触觉 环 的 男 一 个 周期 。 


操作 者 和 触觉 设备 
被 测量 的 操 


V 
IV 


虚拟 环境 真实 GERE) 
环境 


期 望 的 触觉 
显示 输出 


e 


B] 30.1 触觉 循环 
a) 通用 触觉 界面 的 触觉 循环 (触觉 设备 感知 操作 者 的 输 
入 ， 如 位 置 或 力 ， 该 系统 将 这 一 输入 施加 到 一 个 虚拟 或 
遥 操 作 环境 。 需 要 被 传递 给 操作 者 的 环境 响应 通过 建 模 、 
触觉 再 现 、 传 感 和 /或 估计 来 计算 得 到 的 。 最 后 ， 在 触 党 
设备 执行 器 显示 相应 的 接触 感觉 给 操作 者 ) b) 理想 的 
结果 是 操作 者 感觉 他 /她 是 直接 与 真实 环境 在 互动 


尽管 触觉 显示 概念 简单 ， 但 研制 一 种 性 能 出 众 的 
触觉 界面 仍 存在 着 许多 挑战 工作 。 其 中 有 许多 是 通过 
基本 的 机 器 人 理论 和 对 人 触觉 能 力 的 理解 来 解决 的 。 
在 一 般 情 况 下 ， 触 觉 界面 性 能 特征 取决 于 人 的 感知 和 
电机 控制 特性 。 人 为 产生 的 触觉 感受 的 一 个 主要 挑战 
是 当 没 有 与 一 个 虚拟 或 远程 物体 接触 时 人 操作 运动 应 
不 受 限 制 。 触 觉 设备 应 能 满足 操作 者 进行 所 期 望 的 运 
动 ， 因 此 需要 触觉 设备 能 有 足够 的 自由 度 和 驱动 反馈 


性 能 。 各 种 机 器 人 的 设计 中 使 用 的 触觉 设备 ， 包 括 : 
外 骨骼 康复 动力 服 、 驱 动 夹 持 器 、 并 联 和 串联 机 械 
手 、 小 作业 空间 类 鼠标 设备 、 可 以 捕捉 整个 手臂 甚至 
全 身 运动 的 大 作业 空间 设备 。 另 一 个 挑战 是 人 能 够 把 
at 〈 力 /位 置 ) 与 具有 运动 和 控制 信号 的 皮肤 Cfi 
觉 信息 两 者 结合 起 来 形成 触觉 感知 。 理 想 状 态 下 
触觉 设备 应 包括 力 和 触觉 显示 ， 由 于 执行 器 的 大 小 和 
重量 的 限制 ， 这 些 很 难 做 到 。 由 于 人 对 高 频 信息 的 敏 
感性 ， 对 于 许多 触觉 界面 和 应 用 ， 上 述 触 觉 循环 必须 
能 以 高 频率 (通常 1kHz) 重复 。 快 速 更 新 不 仅 提供 
真实 (不 间断 的 ) 触觉 的 感觉 给 人 类 操作 者 ， 它 通 
常 也 有 助 于 保持 系统 的 稳定 性 。 触 觉 设备 的 控制 分 析 
必须 同时 考虑 到 物理 动力 学 的 连续 特性 和 计算 机 控制 
的 离散 特性 。 

在 我 们 详细 地 介绍 触觉 界面 各 种 组 成 部 分 之 
前 ， 通 过 回顾 人 类 触觉 和 触觉 应 用 对 其 设计 应 会 
有 所 启发 。 本 节 的 其 余部 分 就 用 于 阐述 这 些 
内 容 。 


30.1.1 人 类 触觉 


1. 解剖 学 和 生理 学 

人 类 神经 系统 的 两 个 功能 在 触觉 中 扮演 着 重要 角 
色 : 运动 感觉 功能 ( 指 在 肌肉 ,韧带 和 关节 中 感知 
运动 和 力量 的 内 在 感知 功能 ) 和 触动 感觉 功能 (对 
于 皮肤 变形 的 感知 功能 ) 。 触 觉 是 两 者 的 整合 ， 同 时 
也 与 活动 如 操纵 和 探测 相 联 系 。 本 章 主要 阐述 动 觉 交 
互 作 用 意义 上 的 一 些 系统 。 在 30.5 节 将 专门 针对 触 
觉 感知 设备 进行 描述 。 正 如 我 们 所 知道 的 ， 即 使 触觉 
设备 没有 清晰 地 产生 触觉 刺激 ， 触 觉 感官 仍然 会 被 刺 
激 ， 且 能 对 高 达 10000Hz* 的 频率 和 小 到 2 ~ 
4hml 5 的 位 移 有 所 响应 。 

动 觉 是 由 传导 肌肉 拉 伸 的 肌 梭 和 传导 关节 旋 
转运 动 的 高 尔 基 肌 腿 器 官 进 行 传递 的 ， 尤 其 在 极 
端 拉 伸 时 。 一 般 而 言 ， 这 些 感官 和 类 似 感 官 将 由 
刺激 直接 产生 触觉 感觉 。 例 如 ， 振 动 施加 到 肌肉 
肌 用 会 产生 一 个 肌肉 强烈 拉 伸 的 感觉 和 相应 的 人 
体 关 节 运 动 i。 有 关 周 边 神经 刺激 应 用 于 假肢 
控制 的 研究 表明 ， 植 人 在 截肢 者 周边 神经 束 末 端 
的 电极 可 以 受到 激励 而 产生 关于 截肢 者 假手 的 触 
RADE ROO 1。 

2. 心理 物理 学 

在 较 生 理学 和 解剖 学 更 高 一 级 的 水 平 上 ， 心 理 物 
理学 所 0 ， 作 为 感官 物理 能 力 的 科学 ， 是 研发 设计 触 
觉 设备 的 数据 宝藏 。 它 的 首要 贡献 在 于 设计 思路 ， 触 
觉 研究 者 应 用 它 回 答 了 关于 什么 是 触觉 装备 所 必 备 能 
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力 的 问题 。 这 些 感官 能 力 必 将 转化 为 设计 需求 。 一 些 
主流 心理 物理 学 方法 在 触觉 方面 有 着 丰富 的 应 用 ， 其 


方法 (EP), 由 此 刻画 了 人 类 触觉 探索 的 特 
点 中。 他 们 把 物体 放 入 蒙 住 眼睛 的 受 试 者 手中 ， 


中 包括 通过 限制 和 自 适应 自 上 而 下 的 方法 进行 阅 值 测 
量 。 然 而 ， 浆 值 的 感知 并 不 是 100% 可 靠 的。 感知 精 
度 往 往 取 决 于 刺激 强度 和 在 命中 率 与 误 报 率 之 间 的 权 
衡 ， 而 权衡 很 大 程度 取决 于 在 一 个 给 定 的 时 间 间 隔 内 
所 呈现 的 刺激 的 概率 P,,。 

一 个 更 一 般 的 概念 是 接收 器 工作 曲线 ( 见 图 
30.2, 心理 物理 学 家 借用 了 雷达 的 原理 ) 其 描述 了 
一 个 物体 对 于 给 定 刺激 的 响应 概率 相对 应 于 没 给 刺激 
的 概率 响应 。 通 过 测量 在 几 个 不 同时 间 间 隔 P. 的 两 
个 概率 值 生 成 曲线 。 理 想 响应 点 是 (0, 1): 对 于 刺 
激 100% 的 响应 和 对 于 无 刺激 0% 的 响应 。 对 于 远 高 
于 阔 值 的 刺激 人 体 反应 接近 此 点 , 但 是 随 之 成 弧 线 下 
降 最 终 落 在 45" 线 上 ， 低 于 阔 值 的 人 的 反应 完全 变 成 
偶然 。 


命中 率 (P( 是 | 有 激励 )) 
1.0 


| 


M 0.1 0.[2 03 04 0.5 0.6 0.7 0.8 0.9 1.0 
误 报 率 P( 是 | 无 激励 )) 
图 30.2 接收 者 操作 曲线 (ROC)。 ROC 反映 的 是 由 受 试 
者 做 出 对 一 个 有 效 刺 激 在 误 报 风险 与 遗漏 风险 之 间 的 取 
€. 当 激 励 用 一 个 特定 的 概率 来 描述 时 ，ROC 的 每 个 点 都 
代表 在 这 两 种 观测 风险 之 间 特 定 的 取舍 。 对 于 较 强 刺激 信 
息 ROC 会 向 左上 角 偏 移 ( 引 自 参考 文献 [30.1] ， 经 Law- 
rence Erlbaum and Associates,Mahwah 许可 ) 


从 心理 物理 学 的 角度 另 一 个 相关 的 概念 是 最 小 可 
觉 差 (JND), ， 通 常用 百分比 来 表示 。 这 是 在 一 个 刺 
激 中 相对 改变 的 强度 ， 如 力 或 位 移 作 用 到 手指 刚刚 可 
被 受 试 者 觉察 感知 的 强度 。 对 于 范围 在 0.5 ~ 200N 的 
作用 到 人 的 手指 上 的 力 ，Jonest 弛 9 测量 到 其 最 小 可 
党 差 是 6% 。 

3. 心理 学 : 探索 方法 

在 始 于 20 世纪 80 年 代 的 影响 深远 的 研究 中 ， 
Lederman 和 Klatzky 定义 了 手 的 运动 原型 ， 称 为 探索 


录制 受 试 者 的 手 部 动作 。 他 们 的 初步 实验 ”中 表明 ， 
受 试 者 所 使 用 的 探索 方法 可 以 根据 所 需 区 分 的 物体 的 
属性 (纹理 、 质 量 、 温 度 等 ) 加 以 预测 。 他 们 还 表 
明 ， 受 试 者 所 选 的 探索 方法 是 最 能 区 别 该 物体 属性 
的 。 此 外 ， 当 问 及 关于 物体 专门 属性 的 问题 (这 是 
饮食 器 具 还 是 又 子 ?) 时 ， 受 试 者 使 用 两 个 阶段 顺序 
回答 ， 其 中 较 一 般 属性 的 探索 方法 要 优先 于 较 具体 的 
探索 方法 "|。 

Lederman 和 Klatzky 的 八 个 探索 方法 以 及 其 最 适 
用 的 物体 属性 如 下 (ILE 30.3); 

1) 横向 运动 (纹理 ) 。 

2) 按压 (人 硬度 )。 

3) BEER CRUE) 

4) 无 支撑 持 有 (重量) 。 

5) 封闭 轮廓 (全 部 形状 ,体积 ) 。 

6) 轮廓 跟踪 (精确 的 形状 ， 体积) 。 

7) 部 分 运动 测试 (部 分 运动 )。 

8) 功能 测试 (特定 功能 ) 。 


图 30.3 人 的 八 种 探索 方法 (EPs) 之 中 的 四 个 
(E| É Lederman 和 Klatzky 9-197 ) 


这 些 探索 方法 都 是 双手 任务 ， 涉 及 与 手掌 表面 的 
接触 ， 手 腕 的 运动 ， 各 种 自由 度 ， 皮 上 肤 的 触觉 和 温度 
感觉 (如 第 1 种 探索 方法 和 第 3 种 探索 方法 ) ， 以 及 
手 的 动感 感觉 (探索 方法 4) 。 能 够 支持 所 有 这 些 探 
索 方 法 的 触觉 设备 ， 远 远 超 出 了 当今 最 先进 技术 发 展 
水 平 。 然 而 ， 对 触觉 界面 的 设计 这 些 结果 意义 重大 ， 
因为 这 使 得 我 们 从 这 些 探索 方法 中 获得 对 于 触觉 装置 
的 性 能 要 求 。 


觉 学 223 


30.1.2 应 用 实例 


人 们 所 遇 到 最 常见 的 触觉 装置 是 一 个 振动 显示 装 
置 ， 它 在 操作 者 玩 视频 游戏 时 可 提供 触觉 反馈 。 全 
如 ， 当 操作 者 驶 离 虚拟 路 面 或 冲撞 到 一 个 虚拟 墙 时 ， 
手动 杆 振动 表明 行驶 过 颠 艇 路 面 或 显示 冲击 来 代表 撞 
到 坚硬 表面 的 撞击 。 我 们 下 面 要 仔细 观察 两 个 更 加 实 
际 的 例子 ， 医 疗 模拟 器 和 计算 机 辅助 设计 系统 。 此 
外 ， 我 们 将 回顾 几 种 商用 的 触觉 设备 。 触 觉 界面 技术 
虽然 没有 在 娱乐 业 以 外 广 为 商 业 应 用 ,但 是 它们 正在 
被 大 量 集成 到 实际 应 用 中 ， 在 这 些 应 用 场合 其 潜在 的 
利益 足以 证 明 采 用 这 些 新 技术 是 合理 的 。 在 一 系列 领 
域 ， 大 量 新 颖 和 创造 性 应 用 正在 得 到 开发 ， 包 括 
辅助 技术 、 汽 车 、 设 计 、 教 育 、 娱 乐 、 人 机 交 
互 、 制 造 /装配 、 医 学 模拟 、 微 /纳米 技术 、 分 子 生物 
学 、 假 肢 、 康 复 、 科 学 可 视 化 、 空 间 技术 、 外 科 手 术 
Bl A o 

1. 医学 模拟 

如 今 推动 大 量 触 觉 虚 拟 环境 研究 的 重要 例子 之 一 
是 模拟 训练 动手 医疗 过 程 。 医 学 侵入 性 治疗 诊断 过 
程 ， 从 抽取 血液 样本 到 外 科 手 术 对 病人 而 言 都 有 潜在 
的 危险 和 痛苦 ,需要 学 生 通 过 触觉 信息 的 介入 去 体会 
学 习 动 手 技能 ”"。 具 有 和 没有 触觉 反馈 的 仿真 器 
的 目标 是 取代 直接 在 病人 或 动物 身体 上 的 辅导 学 习 。 
仿真 器 在 开发 微 创 手术 技巧 方面 ”已 被 证 明 高 度 
有 效 ， 尤 其 是 在 早期 训练 时 提供 触觉 反馈 5。 对 
于 触觉 模拟 需 训 练 的 预期 益处 包括 : 

1) 在 训练 期 间 和 之 后 降低 病人 危险 。 

2) 提升 模拟 非 寻 常 条 件 或 医疗 紧急 情况 的 能 力 。 

3) 在 培训 过 程 中 收集 物理 数据 与 提供 具体 和 直 
接 的 反馈 给 学 生 的 能 力 。 

4) 增加 单位 教练 员 时 间 的 培训 时 间 输 出 。 

模拟 器 设计 方法 ， 特 殊 医疗 应 用 和 培训 评价 方法 
在 过 去 二 十 年 中 得 到 了 广泛 的 研究 ， 例 如 ， 参 考 文献 
[30. 16，17]。 然 而 ， 这 种 技术 的 成 本 仍然 很 高 。 此 
外 ， 在 模拟 咒 技 术 中 哪些 技术 得 到 改进 ， 并 不 总 是 很 
明确 的 ， 如 触觉 设备 的 性 能 或 软组织 建 模 的 准确 性 ， 
将 导致 改进 临床 表现 并 最 终 受 益 于 病人 。 

2. 计算 机 辅助 设计 

波音 公司 ”研究 了 触觉 界面 的 使 用 ， 用 于 解 
决 计算 机 辅助 设计 (CAD) 中 的 复杂 问题 。 问 题 之 
一 是 验证 一 个 像 飞 机 一 样 的 复杂 系统 的 高 效 维修 保养 
能 力 。 在 过 去 ， 力 学 可 以 验证 在 物理 模型 中 的 程序 
(如 物理 模型 中 部 件 的 更 换 )。 然 而 ， 在 一 些 先进 的 
视觉 CAD 系统 中 这 种 分 析 还 是 很 难 或 者 不 可 能 得 到 


体现 。 开 发 的 VoxMap Pointshell 系统 (ILKI 30.4) 
是 利用 触觉 界面 技术 来 测试 部 件 更 换 功 能 。 从 触觉 界 
面 获得 的 力 觉 使 操作 者 产生 了 复杂 工作 空间 部 件 的 物 
理 约束 导致 的 碰 触 感 。 如 果 维 修 人 员 能 够 在 触觉 界面 
中 移 除 这 一 部 件 ， 这 就 表明 这 一 部 件 可 以 无 需 过 度 拆 解 
进行 维护 。 在 实际 设计 中 ， 这 种 能 力 已 被 证 明 很 有 用 。 


图 30.4 波音 公司 对 复杂 飞机 系统 的 装配 和 维修 核查 的 
计算 机 辅助 设计 (CAD ) 应 用 程序 。 波音 公司 研究 人 
员 开 发 了 Voxmap Pointshell 软件 用 于 非常 复杂 的 六 自由 
度 模型 的 高 效 触 觉 再 现 ( 感谢 Bill McNeely ,Boeing Phan- 
tom Works 提供 ) 


3. 商用 触觉 设备 与 系统 

从 高 保 真 的 研究 设备 到 廉价 的 娱乐 系统 ， 有 各 种 
各 样 可 购买 到 的 触觉 设备 。 一 些 人 研究 者 也 制造 他 们 E 
己 的 触觉 设备 用 来 实现 一 些 新 颖 的 设计 ， 满 足 特定 的 
应 用 要 求 或 节省 成 本 。 在 写 这 篇 文章 时 ， 大 部 分 的 商 
用 触觉 设备 由 两 家 公司 设计 : SensAble 技术 公 
x] 9 A Immersion Z8] 99?! o SensAble 已 研制 开发 
了 手写 笔 型 模拟 线 触 觉 设 备 (WE 30.5), Phantom 


图 30.5 源 于 SensAble 技术 Phantom Omni 模拟 设备 。 
这 种 低 成 本 的 设备 可 以 感应 来 自 于 手写 笔 的 六 自由 度 运 
动 , 也 可 以 在 x,y 和 z 方向 施 力 到 手写 笔 的 笔尖 (感谢 
SensAble Technologies,Inc. ,Woburn 提供 ) 
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Premiumt 2 已 是 迄今 为 止 在 研究 中 最 广泛 使 用 的 触 
党 装置。 触觉 设备 的 高 价格 ( 相 比 视觉 显示 ) 限制 
了 一 些 商业 应 用 的 发 展 。Phantom Omni 比 Phantom 
Premium 便宜 了 一 个 数量 级 ， 在 触觉 与 机 器 人 研究 者 
中 广 受 欢 迎 。2007 4E, Novit”?! 技术 公司 发 布 的 
Novint Falcon， 是 一 个 价格 便宜 的 三 自由 度 触 党 装置 ， 
反 过 来 又 比 Phantom Omni 便宜 一 个 数量 级 。 此 设备 
目标 是 针对 娱乐 应 用 。 


统 主流 是 阻抗 设备 ， 限 于 篇 幅 ， 下 面 的 讨论 仅 局 限于 
这 一 类 型 o 
30.2.1 机 构 

创建 高 保 真 触觉 感觉 ， 操 作者 需要 注意 机 构 设计 
(第 4 章 )。 阻 抗 触觉 设备 的 要 求 是 与 设计 机 械 手 力 
控制 (第 8 章 ) 相 类 似 的 。 对 开 环 力 控制 理想 的 机 
械 属性 包括 低 惯量 ， 高 刚度 ， 和 在 所 设计 的 整个 作业 


Immersion 公司 定位 在 大 众 市 场 和 广大 的 有 多 
种 触觉 产品 需求 的 消费 者 ， 许 多 产品 是 一 个 自由 
度 。 例 如 ， 他 们 把 技术 授权 给 各 种 视频 游戏 的 制 
造 商 以 及 移动 电话 的 三 商 , 来 生产 用 于 驾驶 游戏 
的 具有 振动 反馈 手持 装置 和 触觉 方向 盘 。Immer- 
sion 公司 也 有 医疗 分 支 机 构 销售 具有 触觉 反馈 的 医 


空间 的 良好 的 运动 调节 能 力 ， 以 有 效 地 匹配 合适 的 人 
体 四 肢 ， 主 要 是 手指 或 手臂 。 该 机 构 重 量 应 尽量 减 
少 ， 因 为 它 是 作为 虚拟 环境 或 远程 操作 环境 的 重量 和 
惯性 而 被 操作 者 感知 的 。 运 动 学 奇异 点 (第 1 章 , 第 
4 章 ， 和 第 12 章 ) 对 于 触觉 界面 有 害 ， 因 为 他 们 导 
致 空间 中 某 些 方向 上 ， 人 工 操 作 不 能 移动 到 末端 点 ， 


疗 模拟 器 。 

触觉 再 现 软件 通过 商业 渠道 和 研究 群体 也 已 随处 
可 见 。 销 售 触觉 设备 的 大 多 数 公司 还 提供 具有 触觉 体 
验 能 力 的 标准 开发 工具 包 (SDK)。 此 外 ,不 以 营利 
为 目的 如 Chai3-D 开源 项 目 (www. chai3d. org) ， 目 
的 是 使 得 来 自 不 同 群 体 的 再 现 算法 可 以 公开 ， 以 缩短 
应 用 程序 开发 时 间 ， 并 允许 用 标准 性 能 测试 直接 算法 
比较 。 


30.2 触觉 装置 设计 


触觉 装置 分 为 两 大 类 : 导 纳 型 和 阻抗 型 装置 。 
导 纳 设备 感知 由 操作 者 施加 的 力 和 操作 者 位 置 的 约 
束 以 匹配 在 虚拟 现实 中 的 模拟 物体 或 表面 的 偏转 。 
相 比 之 下 ， 阻 抗 触觉 设备 感知 操作 者 的 位 置 ， 然 后 
根据 模拟 物体 或 表面 的 计算 行为 给 操作 者 施加 一 个 
IRE, 

阻抗 类 型 的 机 器 人 可 反 向 驱动 ， 具 有 低 摩 擦 和 
惯性 ， 并 且 有 力 源 执行 器 。 在 机 器 人 相关 的 研究 中 ， 
一 个 常用 的 阻抗 触觉 装置 是 Phantom. Premium (高 级 
模拟 器 ) COCR) 。 导 纳 类 型 的 机 器 人 ， 如 典型 的 工 
业 机 器 人 ， 是 非 反 向 驱动 的 ， 具有 速度 源 的 执行 器 。 
速度 用 高 带宽 低 增益 控制 器 控制 ， 而 且 被 假定 为 与 
施加 的 外 力 独立 。 一 些 触觉 装置 商品 如 Haptic- Mas- 
ter 7) ， 其 操作 是 导 纳 控制 。 虽 然 这 种 闭环 力 控制 
一 直 使 用 于 触觉 显示 ， 但 设计 师 们 选择 开 环 力 控制 
专门 设计 的 机 构 以 同时 获得 低 成 本 和 高 带宽 更 为 
常见 。 

在 软件 和 硬件 系统 设计 中 ， 导 纳 或 阻抗 架构 的 选 
择 有 许多 深远 的 影响 。 由 于 各 种 原因 ， 包 括 成 本 ， 现 
今 触觉 设备 实现 的 大 多 数 是 阻抗 类 型 的 。 因 为 当今 系 


从 而 产生 在 触觉 装置 与 虚拟 物体 接触 时 的 错觉 ， 因 此 
带 来 干扰 。 当 它们 引进 大 量 摩擦， 必须 避免 高 传动 
比 。 这 一 约束 带 来 触觉 界面 对 于 执行 器 性 能 更 高 的 
要 求 。 

l. 机 械 性 能 的 度量 

理想 的 触觉 设备 在 任意 方向 上 可 以 自由 运 
动 ， 而 且 没 有 奇异 结构 以 及 在 其 附近 产生 对 于 操 
作 的 坏 影 响 。 在 传统 意义 上 ,运动 性 能 由 机 构 的 
雅 可 比 矩 阵 J(p,，g) 导 出 ,使 用 下 列 熟 知 参数 来 
度量 : 

1) 可 操作 性 ”J(p,g) 奇异 值 的 积 。 

2) 机 构 各 向 同性 ,J(p,，g) 最 小 的 奇异 值 
与 最 大 的 奇异 值 之 比 。 

3) 最 小 力 输 出 ”中 ,在 最 差 方 向 上 的 最 大 
力 输出 。 

也 可 以 通过 使 用 如 动态 可 操作 性 度量 ”将 动 
力学 引入 成 本 函数 。 这 仍然 是 研究 热点 之 一 。 关 于 对 
触觉 设备 灵活 性 的 何 种 度量 方法 是 最 适合 的 ， 目 前 尚 
无 定论 。 

2. 运动 学 和 动力 学 优化 

这 方面 的 设计 要 求 机 构 综 合 与 人 (最 常见 如 手 
指 或 手臂 ) 的 工作 空间 相 匹 配 ， 同 时 避免 运动 奇 
异 点 。 
触觉 设备 工作 空间 定义 为 与 规定 人 的 四 有 上肢 指标 相 
匹配 。 这 可 以 借助 通过 使 用 人 体 测量 数据 完成 。 
性 能 目标 ， 如 低 惯量 和 避免 运动 学 奇异 点 ， 必 须 规范 
化 成 对 任何 候选 设计 计算 的 一 个 定量 性 能 测量 。 一 个 
这 样 的 测量 必须 考虑 如 下 要 求 : 

1) 贯穿 整个 目标 空间 运动 调节 的 一 致 性 。 

2) 倾向 具有 低 惯 性 的 设计 。 

3) 确保 目标 空间 可 达 。 
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上 述 定义 的 机 械 性 能 的 测量 是 在 工作 空间 中 一 个 
点 上 的 ， 因 此 对 触觉 装置 设计 指标 而 言 必须 结合 整个 
工作 空间 得 出 一 个 数值 。 例 如 ， 如 果 S 是 所 有 使 得 末 
端 执行 器 是 在 目标 工作 空间 内 部 的 关节 和 角度 O 的 集 
合 ， 这 样 的 测量 可 以 是 
M - minW(O) (30.1) 
式 中 , WOO) 是 设计 性 能 的 测量 。 人 性 能 测量 应 包括 
杆 长 罚 函 数 如 


M z minW(0) /T (30.2) 

以 免 求 得 设计 方案 尺度 、 柔 度 、 质 量 过 大 。 我 们 可 以 
搜索 机 械 设计 大 全 实现 M 最 大 化 。 例 如 ， 如 果 一 个 
设计 有 五 个 自由 度 (通常 为 各 连 杆 长 度 和 偏 移 量 )， 
我 们 对 每 个 参数 研究 十 个 可 能 的 值 ， 这 样 就 必须 评估 
10° 个 设计 。 

现 有 的 计算 能 力 增长 得 远 比 在 人 体 自 由 度数 量规 
模 上 的 实际 机 构 复 杂 性 更 快 。 因 此 ， 通 常 对 于 设计 空 
间 进 行 遍历 搜索 就 足够 了 ， 复 杂 的 优化 方法 没 必要 。 

3. 接地 与 不 接地 装置 
目前 ， 提 供 动 党 反馈 的 大 多 数 设备 是 完全 接地 
的 ， 也 就 是 ， 操 作者 感觉 到 的 力 是 关于 操作 者 的 地 
的 ， 如 地 面 或 桌面 的 。 非 接地 触觉 反馈 装置 更 多 是 可 
移动 的 ， 而 且 与 接地 装置 相 比 可 以 在 更 大 的 作业 空间 
中 操作 ， 能 够 使 它们 用 在 大 型 虚拟 环境 中 。 大 量 的 非 
接地 的 动 觉 反馈 装置 已 被 开发 ， 例 如 参考 文献 
[30.31-33]。 也 已 有 很 多 非 接 地 装置 的 性 能 和 接地 
触觉 显示 之 间 的 比较 Y 当 。 一 些 非 接 地 装置 提供 触 
觉 而 不 是 动 觉 的 感觉 ， 这些 在 30.5 FTP Bx. 


触觉 设备 需要 传感器 来 测量 该 设备 的 状态 。 这 种 
状态 可 能 会 被 操作 者 提供 的 位 置 / 力 ， 触 觉 控 制 法 则 ， 
和 /或 设备 与 环境 动态 改变 。 操 作者 的 输入 是 以 所 提 
供 的 位 置 或 施加 的 力 的 方式 被 感知 的 。 对 于 触觉 传 感 
的 要 求 类 似 于 其 他 机 器 人 设备 (第 20 章 ) 的 传 感 ， 
所 以 这 里 只 讨论 一 些 特有 的 触觉 传 感 问题 。 

1. 编码 器 

旋转 式 光电 直角 编码 带 通 常用 作 触 觉 设 备 关 节 的 
位 置 感知 。 他 们 经 党 与 作为 执行 器 的 旋转 电动 机 相 结 
合 。 编 码 器 底层 传 感 机 构 在 20.1 节 进 行 了 介绍 。 触 
觉 设 备 编码 器 所 需 的 分 辨 率 ， 取 决 于 一 个 单一 编码 器 
刻度 的 角 距 离 与 笛 卡 儿 空间 的 终点 间 运 动 距离 之 比 。 
选 定 的 位 置 编码 器 的 分 辨 率 其 影响 已 远 不 止 是 操作 端 
的 简单 空间 分 辨 率 ， 还 包括 在 没有 不 稳定 或 非 被 动 行 
AU! 的 条 件 下 所 再 现 的 最 大 刚度 (30.4 节 )。 


许多 触觉 应 用 ， 如 具有 阻尼 的 虚拟 环境 的 体验 
(此 时 力 与 速度 成 正比 ) 需要 速度 测量 。 速 度 通常 是 
通过 编码 器 的 位 置信 号 的 数值 微分 获得 的 。 对 速度 佑 
计 的 算法 必须 选择 那些 没有 噪声 并 且 在 所 关心 的 频率 
上 相位 滞后 达到 最 小 所 55 的 方法 。 因 此 ， 另 一 方法 
是 使 用 专用 仪器 测量 编码 器 刻度 间 对 应 的 时 间 来 计算 
EET 。 

2. 力 传感器 

和 触觉 装置 中 力 传 感 器 用 于 操作 者 对 一 个 导 纳 控制 
设备 的 输入 ， 或 作为 一 种 机 构 在 一 个 阻抗 控制 装置 消 
除 设 备 摩 擦 和 其 他 不 希望 的 动态 特性 。 力 传感器 在 
20.4 节 进 行 了 介绍 。 当 使 用 一 种 测 力 传 感 器 如 应 变 
计 或 荷 重 单元 测量 操作 者 施加 的 力 时 ， 必 须 注意 采取 
热 绝 缘 传感器 ， 因 为 由 身体 热量 引发 的 热 梯度 能 影响 
传感器 力 读 数 。 


30.2.3 ”驱动 和 传动 


触觉 设备 有 别 于 传统 计算 机 输入 设备 ， 其 通过 控 
制 的 执行 器 提供 合适 的 触觉 感觉 给 操作 者 。 和 触觉 设备 
的 性 能 很 大 程度 取决 于 执行 机 构 的 性 质 和 机 械 传动 在 
执行 器 和 触觉 交互 点 (HIP) 之 间 的 传输 。 下 面 介绍 
一 下 对 触觉 技术 的 要 求 。 

在 阻抗 型 触觉 设备 中 对 执行 器 和 机 械 传动 的 基本 
要 求 是 : 低 惯 性 、 低 摩擦 、 低 力矩 脉动 、 可 反 向 驱动 
和 低 的 反 向 作用 。 此 外 ， 如 果 设 计 成 执行 器 本 身 随 着 
用 户 位 置 变 化 而 运动 ， 那 就 需要 较 高 的 功率 重量 比 。 
尽管 在 阻抗 型 装置 中 闭环 力 控制 已 被 用 于 触觉 显示 ， 
最 常见 的 机 构 设计 还 是 有 足够 低 的 摩擦 和 惯性 以 保证 
足够 准确 的 开 环 力 控制 。 

对 触觉 设备 而 言 ， 一 个 常见 机 械 传动 设备 是 绞盘 
驱动 的 〈 见 图 30.6) ， 由 缠 着 线束 的 不 同 直径 的 滑轮 
来 提供 传动 比 。 在 线束 和 滑轮 之 间 保 持 无 滑动 ， 高 摩 
PRAT fh, FEU Ze SENATOR SCL , HAR 
dca otis AT VASE ER EAA AB BE RS SN, DAL 
它 能 防止 在 电动 机 和 关节 轴 上 的 平移 力 。 

电流 放大 融通 常 被 用 于 产生 通过 数字 一 模拟 
(D/A) 转换 器 用 计算 机 产生 的 输出 电压 与 由 电动 机 
产生 的 转 矩 输出 之 间 的 直接 联系 。 相 对 于 大 多 数 触 觉 
设备 的 位 置 传感器 的 分 辨 率 和 采样 率 ， 执 行 器 与 放大 
Ti HT S SS VERE LA D/A 分 辨 率 对 系统 稳定 性 的 作用 
通常 可 以 忽略 不 计 。 执 行 器 或 放大 融 饱 和 ， 可 导致 性 
能 变 差 ,特别 是 多 自由 度 触觉 设备 ， 一 个 单一 饱和 电 
动机 力矩 可 能 会 明显 改变 虚拟 物体 的 几何 外 观 。 从 而 
如 有 任何 执行 器 处 在 饱和 状态 时 ， 力 矢量 以 及 相应 执 
行 圳 的 力矩 必须 适当 予以 估计 。 
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位 置 传 感 编码 器 ， 一 个 单一 轴 力 传感器 
和 用 于 驱动 绞盘 传动 的 有 刷 电动 机 


30.2.4 ”装置 实例 


作为 一 个 示意 性 例证 ， 我 们 将 对 一 个 简单 的 一 
个 自由 度 被 称 之 为 触觉 垫 的 触觉 装置 提供 详细 的 设 
计 信 息 。 本 节 是 为 了 提供 具体 部 件 类 型 的 描 
述 ， 这 些 部 件 用 于 运动 触觉 设备 。 该 设备 可 以 根据 
约翰 霍 普 金 斯 大 学 提供 的 指导 说 明 构建 后 ?1 。 许 多 
广泛 使 用 的 触觉 设备 拥有 与 该 设备 共同 的 工作 原理 ， 
主要 不 同 在 于 ， 由 于 较 多 的 自由 度 ， 在 运动 细节 上 
有 所 区 别 。 

如 图 30.6 所 示 ， 触 觉 垫 配备 有 两 个 传感器 
位 置 编码 器 和 力 传感器 。 一 个 每 转 计 500 个 数 的 
Hewlett- Packard HEDS 5540 编码 器 直接 安装 在 电动 
机 上 。 正 交 过 程 使 得 每 转产 生 2000 个 计数 ,绞盘 
齿轮 的 传动 比 和 杆 辟 使 得 在 HIP 的 位 置 分 辩 率 为 
2.24 x 107? m, Measurement Computing 公司 的 PCI- 
Quad04 Hy FH ole 53 Zi 05 48 AE BE, Entran x 10N 
测 力 传 感 器 (型 号 ELFS -T3E -10N) 用 来 衡量 
加 的 操作 力 。 聚 甲醛 单 使 得 测 力 传感器 能 够 热 绝 
缘 。 在 此 装置 上 ， 测 力 传感器 可 通过 控制 机 制 来 
尽量 减少 摩擦 的 影响 ,该 控制 机 制 为 当 HIP 不 与 
虚拟 物体 接触 时 ， 它 试图 使 得 操作 者 施加 的 力 减 
少 到 零 。 从 测 力 传感器 所 获得 的 信号 ， 在 由 16 位 
A/D (PCLDAS6402 配置 的 范围 在 +1.25 V) 读 出 
之 前 ,通过 一 个 增益 为 5 的 仪表 放大 器 (Burr- 
Brown INA103) 进行 放大 。 

执行 器 是 Maxon 有 刷 直 流 电 动机 (型 号 
118754m RE -25) , ， 铅 滑轮 固定 在 电动 机 的 轴 上 。 
像 许 多 的 商业 触觉 设备 一 样 ， 缆 束 多 次 缠绕 驱动 滑 


轮 ， 并 固定 在 大 的 从 动 轮 上 。Measurement Compu- 
ting 公司 的 PCI- DAS6402 数据 采集 卡 是 用 来 为 电动 
机 放大 器 输出 电压 的 。 这 是 一 个 16 HEE D/A, 配置 
为 +10 Vo D/A 的 输出 通过 电流 放大 器 ， 该 电流 放 
大 需 输 出 的 电流 通过 电动 机 与 D/A 的 输出 电压 成 正 
比 。 电 流放 大 器 是 以 National Semiconductor 公司 的 
LM675 功率 运算 放大 带 为 基础 构建 的 。 这 使 得 电动 
机 上 施加 的 力矩 直接 受到 控制 。 在 最 终生 成 的 系统 
中 ， 静 态 操作 条 件 下 ， 在 驱动 点 感受 到 的 力 与 输出 
电压 成 比例 (1.65N/V) 。 当 系统 运动 时 ， 由 于 不 同 
的 人 和 设备 动力 特性 ， 操 作者 所 受到 的 力 可 能 会 

所 不 同 。 


30.3 触觉 再 现 

触觉 再 现 (在 阻抗 系统 中 ) 是 一 个 基于 操作 者 
运动 的 测量 ， 通 过 与 虚拟 物体 接触 计算 所 需要 力 的 过 
程 。 本 节 介 绍 虚拟 环境 的 触觉 再 现 。 对 遥 操 作 触 觉 反 
馈 将 在 第 31 SEPREYR 

触觉 系统 一 个 重要 的 属性 是 它们 的 时 间 约 束 是 相 
当 严 格 的。 为 了 说 明 这 一 点 ， 试 着 用 铅笔 敲 击 桌面 加 
以 验证 。 你 听 到 的 在 笔尖 和 桌面 之 间 是 一 个 在 接触 动 
力学 里 音频 表征 的 声音 。 人 和 手指 上 的 触觉 感受 器 的 响 
应 可 高 达 lOkHzU^"! 。 为 了 真实 地 再 现 两 个 硬 表面 之 
间 的 这 类 触 碰 ， 对 进入 音频 范围 (高 达 20kHz) 需要 
有 更 好 的 响应 ， 因 此 采样 时 间 大 约 为 23us。 即 使 有 
特殊 的 设计 ， 和 触觉 设备 也 不 具备 这 样 的 带宽 ， 同 时 这 
样 高 保 真 通常 也 不 是 触觉 再 现 的 目标 。 为 了 达到 稳定 
再 现任 何 类 型 的 硬 接触 需要 有 非常 高 的 采样 率 。 实 际 
上 ， 建 造 大 多 数 触觉 模拟 系统 至 少 要 1000Hz 采样 率 。 
如 果 虚 拟 环境 被 限制 成 软 材料 ， 这 可 以 被 减少 到 几 百 
赫兹 以 下 。 

1. 基本 的 触觉 再 现 
每 个 周期 触觉 再 现 的 计算 过 程 由 以 下 七 个 连续 步 
又 组 成 (ILE 30.7) 。 为 了 达到 稳定 和 真实 的 效果 ， 
再 现 周 期 一 般 必 须 在 lms 内 完成 : 中 感应 (30.2.2 
节 ) ; @ 运 动 学 ; 名 碰撞 检测 ; @ 确 定 表面 点 ; OA 
计算 ; @ 运 动 学 ; GO 驱动 (30.2.3 节 ) 。 

2. 运动 学 

在 关节 空间 中 ， 通 常 需要 使 用 传感器 来 进行 位 置 
和 速度 的 测量 。 这 些 必 须 通 过 正 运动 学 模型 和 雅 可 比 
矩阵 (第 1 章 ) 转换 成 操作 者 手 或 指 尖 的 笛 卡 儿 空 
间 中 的 位 置 和 速度 。 在 一 些 应 用 中 ， 操 作者 虚拟 地 抓 
持 一 个 工具 或 物体 ， 这 些 工具 或 物体 的 形状 在 虚拟 环 
境 中 是 象征 的 ， 但 是 它们 的 位 置 和 方向 是 确定 的 。 在 
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图 30.7 阻抗 型 触觉 显示 系统 的 触觉 再 现 周 期 示意 图 (根据 
操作 者 的 触觉 装置 的 位 移 虚拟 对 象 在 虚拟 环境 中 运动 。 在 设 
备 中 感知 的 关节 位 移 @ 中、 通过 运动 学 2、 碰 撞 检 测 (3、 表 
面 点 的 确定 四 、 力 计算 (5)、 运 动 学 @ 和 驱动 7) 得 到 处 理 。) 


其 他 的 情形 ， 操 作者 的 指 尖 或 手 由 一 个 点 来 表示 ， 在 
虚拟 环境 (VE) 中 仅 该 点 与 物体 相 接触 。 我 们 将 虚 
拟 物 体 当 做 一 个 虚拟 工具 ， 同 时 将 这 个 点 称 为 
接触 交互 点 (HIP) 。 

3. 碰撞 检测 

对 于 点 接触 的 情况 ， 碰 撞 检 测 软件 必须 确定 HIP 
的 位 置 是 否 就 是 在 当前 时 刻 与 虚拟 对 象 接 触 的 点 。 这 
通常 意味 着 确定 HIP 是 否 穿 透 物 体 表 面 或 者 在 物体 
内 部 。 物 体 表 面 由 多 边 形 或 样 条 曲线 等 几何 模型 
表示 。 

在 计算 机 图 形 学 方面 昌 有 大 量 关 于 碰撞 检测 
的 文献 ， 但 是 触觉 碰撞 检测 有 其 独到 之 处 。 特 别 
是 ， 计 算 速 度 至 关 重 要 ， 还 有 最 坏 情 形 下 的 速度 ， 
而 不 是 平均 速度 。 首 选 的 是 要 在 固定 时 间 内 估计 
出 解 。30. 3. 1 节 提 出 对 复杂 环境 的 碰撞 检测 和 触 
觉 再 现 。 
如 果 检 测 到 HIP 在 所 有 物体 之 外 ， 则 力 返 回 
4. 确定 表面 点 
一 旦 确定 HIP 在 某 个 物体 的 内 部 ， 就 必须 计算 
出 来 应 该 显示 给 操作 者 的 力 的 大 小 。 许 多 研究 者 采 
用 的 思路 是 ， 用 一 个 虚拟 的 弹簧 将 HIP 与 距离 最 近 
的 物体 表面 的 一 点 相连 ， 并 将 此 作为 渗透 模型 和 力 
HÆ R HER AY L30 40-42] o Basdogan 和 Srinivasan 将 此 点 命 
名 为 中 间 触 觉 交互 点 (IHP)。 然 而 ， 大 家 都 意识 
到 最 接近 的 表面 点 模型 并 不 总 是 最 好 的 接触 模型 。 
例如 ， 当 HIP 沿 着 立方 体 的 项 面 以 下 进行 横向 移动 
时 (ILEI 30.8) ， 最 终 该 点 将 足够 接近 边缘 ， 而 使 
得 最 接近 表面 的 点 实际 上 在 立方 体 的 一 个 侧面 。 这 


个 算法 需要 保存 顶部 表面 的 IHP， 并 且 始 终 产生 一 
个 向 上 的 力 ， 和 否则 操纵 者 会 突然 从 立方 体 的 侧面 弹 
射出 来 。 


n um 


图 30.8 一 种 在 触觉 再 现 中 接触 力 的 巧妙 处 理 方法 示意 图 
图 30.8 中 ,操作 者 指 尖 轨迹 进入 物体 表面 向 右 下 移动 ， 
触觉 交互 点 (HIP) 在 时 刻 1 ~4 FASO, Py ~ P, 显示 。 
当 HIP 在 对 象 内 部 时 中 间 触 觉 交 互 点 (HIP) 用 空心 圆 表 
S。 在 位 置 P, ， 不 应 采用 基于 最 接近 表面 点 的 接触 力 再 
岗 算法 ， 否 则 将 会 导致 操作 者 受到 从 侧 表面 的 作用 力 ( 
F 这 个 力 与 顶端 表面 相 切 所 以 会 感觉 不 自然 ) 。 
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5. 力 计算 
力 通常 是 使 用 弹簧 模型 来 计算 ( 胡 克 定律 ) 
f=kx (30.3) 
式 中 , x 是 从 HIP 到 IHIP 的 矢量 ， 并 且 大 >0。 当 大 


充分 大 时 ， 物 体 的 表面 会 感觉 像 一 堵 墙 垂直 Y。 这 个 
虚拟 墙 ， 换 言 之 ， 阻 抗 表 面 ， 是 大 多 数 触觉 虚拟 环境 
的 一 个 基本 构造 块 。 由 于 虚拟 墙 仅 当 检测 到 HIP 和 
虚拟 物体 之 间 的 碰撞 时 才 显 示 ， 虚 拟 墙 是 单 边 约束 ， 
被 一 个 非 线 性 的 切换 条 件 控制 。 如 同 在 以 下 章节 所 
述 ， 具 有 复杂 几何 形状 的 触觉 虚拟 环境 通常 由 一 个 多 
边 形 网 格 形成 ， 其 中 每 个 多 边 形 本 质 上 是 一 个 虚拟 
墙 。 在 与 操作 者 局 部 的 交互 是 靠 虚 拟 墙 控制 时 ， 虚 拟 
表面 也 可 以 允许 全 局 变形 。 通 常 构建 在 虚拟 墙 上 的 虚 
拟 着 力 点 ， 它 们 可 以 被 覆盖 在 触觉 反馈 点 上 使 得 远程 
操作 者 在 进行 远程 操作 任务 时 可 以 协助 当地 操作 者 
(第 31 章 ) 。 

上 文 所 述 的 纯 刚 度 模型 可 以 扩充 以 提供 其 他 作 
用 ， 特 别 是 通过 使 用 虚拟 耦合 ， 这 将 在 30.3.2 Wie 
述 。 阻 尼 (参量 ) 可 以 垂直 或 平行 地 加 到 表面 上 。 
另外 ， 库 仑 摩擦 或 其 他 非 线 性 摩擦 也 可 平行 加 到 表面 
上 。 为 了 提供 更 真实 的 坚硬 表面 的 感 党 ， 在 碰 触 瞬 
间 ， 在 表面 和 HIP 之 间 振 动 也 可 以 以 开 环 的 方式 表 
示 ， 如 30.5 节 所 述 。 

6. 运动 学 

在 笛 卡 儿 空间 计算 的 力 必须 转化 为 执行 器 空间 的 
力矩 。 通 常情 况 下 其 计算 是 
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T-Jf (30.4) 
式 中 ，z 是 执行 需要 求 的 力矩 ; 了 是 期 望 的 力 矢 
量 ; 三 是 触觉 装置 雅 可 比 矩 阵 的 转 置 和 矩阵 (第 1 
章 ) 。 如 果 和 触觉 装置 没有 动力 损耗 并 且 执 行 器 是 
理想 的 ， 提 供给 操作 者 的 力 将 是 精确 的 。 然 而 ， 
实际 设备 的 动力 损耗 、 时 间 延 迟 以 及 其 他 非 理 想 
的 条 件 ， 使 得 提供 给 操作 者 的 力 与 所 期 望 的 力 是 
不 同 的 。 


30.3.1 复杂 环境 再 现 


使 用 各 种 相对 简单 的 算法 对 简单 虚拟 环境 中 的 触 
觉 进 行 有 效 的 再 现 ， 当 今 电 脑 的 能 力 就 足够 了 。 虚 拟 
环境 通常 由 几 个 简单 的 几何 图 元 组 成 ， 如 球体 、 立 方 
体 、 和 平面 。 然 而 ， 现 在 的 挑战 是 扩展 这 些 算法 以 应 
对 复杂 的 环境 ， 如 同 我 们 通常 所 看 到 的 包含 10”~ 10" 
个 多 边 形 的 计算 机 图 形 再 现 。 在 文献 中 报道 了 多 种 方 
法 尝试 对 复杂 场景 进行 有 效 再 现 。Zilles 和 Salisbur- 
yt 根据 相 邻 的 表面 多 边 形 之 间 的 平面 约束 ， 利 用 
拉 格 朗 日 乘 子 求 得 了 最 接近 IHIP 的 点 。Ruspini 等 
人 号 4 发 展 了 力 涂 色 (force shading) 和 摩擦 模型 。 
Ho 等 人 中 使 用 包 络 球 域 的 层次 结构 以 确定 初始 接 


对 于 手术 模拟 ， 研 究 人 员 将 主要 精力 放 在 手术 器 
械 和 器 官 之 间 的 相互 作用 的 建 模 和 触 党 再现 上 。 研 究 


人 员 曾 试图 用 多 种 方法 为 虚拟 组 织 的 行为 建 模 。 这 些 
方法 大 致 可 划分 为 : 


1) 基于 线性 弹性 的 方法 ; 

2) 基于 非 线性 〈 超 弹性 ) 弹性 的 有 限 元 (FE) 
方法 ; 

3) 不 基于 有 限 元 方法 或 连续 介质 力学 的 其 他 

普通 的 线性 和 非 线 性 有 限 元 算法 不 能 满足 实时 
运行 要 求 ， 然 而 一 些 方法 如 预 处 理 方法 可 以 运行 它 
们 达到 触觉 的 速率 **”l。 许 多 研究 人 员 依 靠 从 真实 
组 织 所 获得 的 数据 为 器 官 变 形 和 断裂 准确 建 模 。 在 
这 一 领域 主要 挑战 包括 结缔 组 织 支 持 器 官 的 建 模 ， 
设备 和 组 织 之 间 的 摩擦 和 在 微 创 手术 过 程 中 发 生 的 
拓扑 变化 。 


30. 3. 2 


虚拟 耦合 

迄今 为 止 ， 我 们 都 是 通过 计算 一 个 虚拟 弹 自 的 长 
度 和 方向 ， 并 应 用 胡 克 定理 式 (30.3) 来 进行 力 的 
再 现 的 。 这 个 弹 答 是 在 HIP 和 THIP 之 间 的 虚拟 耦合 
的 一 种 特殊 情形 5 咏 21 。 虚 拟 耦 合 是 力 再 现 的 渗透 模 


触 ( 碰 撞 ) 点 ， 然 后 搜索 邻近 的 表面 、 边 缘 和 当前 
接触 的 三 角形 的 顶点 〈 几 何 图 元 ) ， 以 此 找到 最 接近 


IHIP 的 点 。Gregory 等 人 马 生 施加 一 个 离散 三 维 (3- 
D) 空间 的 层次 结构 ， 以 加 速 检测 与 该 表面 的 初始 连 
Bi. Johnson 等 人 中 基于 局 部 极 值 进行 了 在 运动 
模型 上 的 触觉 再 现 ， 该 局 部 极 值 为 触觉 设备 所 控制 的 
模型 与 场景 其 余部 分 之 间 的 距离 。Lin 和 
Otaduy ^ “1 使 用 对 象 详细 描述 用 以 执行 多 分 辩 率 碰 
撞 检测 ， 从 而 实现 满足 实时 约束 同时 最 大 限度 地 提高 
计算 邻近 信息 的 准确 性 的 目标 。 

不 将 物体 的 表面 以 多 边 形 来 表示 ， 也 可 以 找到 替 
代 算法 和 效率 。Thompson 和 Cohen" *! Ja Fes n] oA 
从 非 均 匀 有 理 BREA (NURBS) 模型 直接 计算 表面 
的 渗透 深度 。McNeely AO TEE KAA [RC 
三 维 网 格 化 的 极端 做 法 。 每 个 网 格 包 含 一 个 预先 计算 
的 法 向 量 、 刚 度 属 性 等 。 利 用 复杂 的 CAD 模型 ， 可 
以 进行 1000Hz 的 再 现 ， 这 些 CAD 模型 包含 数 百 万 个 
多 边 形 ( 以 图 形 等 价 表示 ) ， 但 是 这 个 方法 需要 大 量 
的 内 存 ， 并 且 需 要 进行 预计 算 。 该 算法 有 足够 高 的 性 
能 ， 它 可 以 同时 被 用 来 再 现 数 百 个 接触 点 。 这 使 得 操 
作者 可 以 操纵 任意 形状 的 工具 或 对 象 。 该 工具 /对 象 
被 表现 为 一 些 表面 点 ， 在 该 工具 上 产生 的 力 和 力矩 是 
表面 上 所 有 点 相互 作用 力 的 总 和 。 


型 的 抽象 。 我 们 假设 物体 是 刚性 的 ， 而 不 是 柔性 的 ， 
但 是 通过 一 个 虚拟 的 弹 签 将 它们 与 操作 者 相连 。 如 此 
就 构建 了 (虚拟 耦合 的 ) 等 效 最 大 刚度 。 

稳定 接触 的 再 现 (30.4 节 ) 问题 往往 需要 更 复 
杂 的 虚拟 耦合 而 不 只 是 一 个 简单 的 弹簧 。 例 如 ， 可 以 
增加 阻尼 。 一 般 地 ， 式 (30.3) 中 力 的 再 现 模 型 可 
以 化 为 


f=kx +bx (30. 5) 
参数 和 4 可 以 赁 经 验 调 整 来 达到 稳定 和 高 性 能 操 


E 
作 。 更 规范 的 虚拟 耦合 设计 方法 将 在 30.4 节 进 行 
AN 


30.4 触觉 界面 的 控制 和 稳定 


1. 问题 简介 

如 图 30.7 所 示 ， 和 触觉 再 现 系统 是 一 个 闭环 动态 
系统 。 再 现在 自然 界 中 人 与 环境 接触 时 的 实际 接触 力 
使 之 保持 稳定 行为 仍然 是 一 个 巨大 的 挑战 。 触 觉 界面 
的 不 稳定 性 以 其 自身 的 噪声 、 振 动 、 其 至 失去 控制 的 
发 散 行为 表现 出 来 。 对 阻抗 器 件 来 说 ， 最 坏 的 情形 发 
生 在 其 试图 与 刚性 物体 接触 过 程 中 。 根 据 以 往 经 验 ， 
在 研制 触觉 界面 与 刚性 虚拟 对 象 时 ， 会 经 常 遇 到 不 稳 
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定性 。 但 通过 减少 虚拟 物体 的 刚性 ， 或 操作 者 较 坚 实 
地 握 持 住 触觉 设备 ， 这 种 不 稳定 性 可 以 被 消除 。 

2. 经 典 控制 理论 的 问题 描述 

尽管 线性 理论 在 应 用 中 使 用 很 有 限 ， 但 是 可 以 用 
它 来 对 不 稳定 性 影响 因素 进行 基本 分 析 所 ?1] 。 一 个 
高 度 简化 的 阻抗 器 件 模 型 如 图 30. 9 所 示 。G1(s) 和 
G,(s) 分 别 描述 同时 具有 操作 位 置 感知 和 力 的 显示 
两 方面 功能 的 触觉 装置 的 动力 学 结构 。 假 设 虚拟 环境 
和 人 操作 者 /用 户 (HO) 都 可 以 通过 线性 阻抗 表 
示 ， 如 


_Fye(s) 

Za =F G5) (30.6) 
_ Fao(s) 

Zu =X (s) (30.7) 


则 从 人 操作 者 开始 又 回 到 人 操作 者 闭环 系统 的 环 路 增 


di 


Z os 
G,(s) TORO ES 


在 传统 意义 上 ， 稳 定性 是 通过 对 C(s*) 15 HIRED 
特 幅 度 和 相位 判 据 来 估计 的 。 增 加 的 Zu (相当 于 更 
硬 的 或 更 重 的 虚拟 物体 ) 也 增加 了 Go (s) 的 幅度 ， 
从 而 系统 趋 于 不 稳定 ， 而 当 操作 者 握 持 更 稳固 时 ， 这 
增加 了 Zuo 的 幅度 ， 从 而 促进 了 稳定 性 。 类 似 的 分 析 
也 适用 于 可 能 出 现在 系统 任何 部 分 的 相 移 。 

3. 线性 理论 的 局 限 性 

尽管 图 30. 9 所 示 的 模型 显示 了 触觉 界面 稳定 性 
的 一 些 特性 ， 但 是 线性 连续 理论 在 环 路 的 稳定 性 设计 
方法 上 很 少 使 用 。 令 人 感 兴趣 的 是 虚拟 环境 是 非 线 性 
的 。 尤 其 是 ， 由 于 应 用 经 常 性 地 模拟 非 连 续 接触 ， 例 
如 ， 在 自由 空间 和 坚硬 的 表面 之 间 的 手写 笔 ， 因 此 很 
难 被 线性 化 。 另 一 特性 是 数字 化 而 引入 采样 和 量化 ， 
这 两 者 都 有 显著 影响 。 


(30. 8) 


图 30.9 触觉 再 现 的 高 度 简化 线性 模型 
可 以 突出 一 些 稳定 性 问题 


4. 采样 
Colgate 等 人 '**| 在 稳定 性 分 析 中 合并 考虑 离散 
采样 行为 。 他 们 考虑 实现 刚性 的 虚拟 墙壁 问题 


z-l 


Tz 
XB, K 为 虚拟 墙 刚 度 ; B 虚拟 墙 的 阻尼 系数 ; z 为 z 
变换 变量 ; 7 为 采样 时 间 。 在 连续 时 间 模 拟 触觉 设备 
(HD) 进一步 模型 化 为 


1 
Zi (s) 二 


式 中 , om Fil b 分别 是 触觉 设备 的 质量 和 阻尼 。 对 于 无 
源 性 设备 他 们 得 到 下 面 的 条 件 


H(z) =K+B (30.9) 


(30. 10) 


b». | 有 | (30. 11) 
表明 高 采样 率 和 在 触觉 设备 中 高 机 械 阻 尼 显 著 的 稳定 
作用 。 

5. 量化 


另外 的 因素 包括 由 于 数值 化 积分 以 及 量化 导致 的 
延 时 。 这 些 不 稳定 因素 已 被 Gillespie 和 Cutkosky 7 57 
称 为 能 量 泄漏 。 

6. 无 源 性 

令 人 关注 的 虚拟 环境 总 是 非 线性 的 并 且 人 工 操作 
者 的 动态 特性 也 是 重要 的 。 这 些 因素 使 得 很 难 用 已 知 
参数 和 线性 控制 理论 分 析 触 党 系统。 卓有成效 的 方法 
之 一 是 使 用 无 源 性 的 方案 以 保证 稳定 运行 。 无 源 性 对 
稳定 性 而 言 是 一 个 充分 条 件 ， 而 且 在 第 31 章 针对 和 远 
程 机 器 人 有 更 详细 的 介绍 。 和 触觉 界 面 和 双向 远程 控制 
之 间 有 许多 相似 之 处 。 

利用 无 源 性 进行 触觉 交互 系统 设计 的 主要 问题 是 
它 过 于 保守 ， 如 参考 文献 [30.35] 所 述 。 在 许多 情 
况 下 ， 在 所 有 操作 条 件 下 采用 一 个 固定 的 阻尼 值 用 于 
保证 无 源 性 ， 系 统 性 能 会 很 差 。Adams 和 Hannaford 
从 适合 于 所 有 的 因果 关系 组 合 的 二 端 网 络 理论 得 到 虚 
拟 解 耦 设计 方法 ， 而 且 比 基于 无 源 性 设计 具有 更 少 保 
SPEEDO) 。 他 们 利用 触觉 设备 的 动态 模型 和 借助 满 
Æ Lewellyn 的 绝对 稳定 性 判 据 得 到 最 优 虚拟 耦合 参 
数 ， 该 绝对 稳定 性 判 据 是 由 项 组 成 的 一 个 不 等 式 ， 这 
些 项 是 结合 触觉 界面 与 虚拟 耦合 系统 的 二 端口 网 络 摘 
述 模 型 的 项 。Miller 等 人 导出 了 男 一 个 设计 方法 : 该 
方法 将 分 析 推 广 到 非 线 性 环境 ， 并 提取 一 个 阻尼 参数 
以 保证 稳定 运行 3 。 


30.5 触觉 显示 


触觉 显示 是 用 来 表示 力 、 接 触 和 形状 信息 给 皮 
肤 。 他 们 故意 刺激 皮肤 感受 器 ， 对 动 觉 的 感觉 影响 较 
小 。 与 这 章 前 面 介 绍 的 动 觉 不 同 ， 前 面 的 重点 是 力 的 
显示 ， 同 时 考虑 提供 通过 与 工具 或 探 针 进行 物理 接触 
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的 皮肤 触觉 。 触 觉 显示 通常 被 用 来 实现 特殊 的 目的 ， 
如 接触 显示 ， 接 触 定位 ， 滑 动 / 剪 切 ,纹理 和 局 部 形 
状 。 这 在 一 些 方 面 是 合理 的 ， 对 于 不 同类 型 的 皮肤 感 
受 器 ， 每 种 都 有 他 们 各 自 的 频率 响应 、 接 受 域 、 空 间 
分 布 和 感受 参数 (如 局 部 皮肤 的 曲率 、 皮 肤 伸展 和 
振动 ) 等 。 它 们 也 与 不 同 的 探索 方法 是 相关 的 ， 如 
30. 1. 1 节 所 述 。 

与 动 觉 显示 相反 ， 和 触觉 显示 的 设计 和 原型 构 
建 对 于 虚拟 现实 或 远程 操作 再 现实 际 的 接触 信息 
是 非常 具有 挑战 性 的 。 准 确 再 现 ， 在 每 个 指 尖 的 
局 部 形状 和 压力 分 布 需要 执行 器 的 密集 阵 。 关 于 
触觉 接收 设备 的 研究 是 一 个 热点 领域 ， 但 是 大 部 
分 还 没有 达到 应 用 阶段 或 商业 流通 阶段 ， 只 有 为 
育 人 所 用 的 著名 盲文 显示 需 除 外 。 在 这 节 中 ， 我 
们 将 介绍 各 种 类 型 的 触觉 显示 ， 他 们 的 设计 思路 、 
实现 算法 和 应 用 。 


30.5.1 振动 反馈 


振动 反馈 是 一 种 提供 触觉 反馈 的 常用 方法 。 它 可 
以 作为 触觉 反馈 的 单独 方法 或 者 动 觉 显 示 的 一 种 补充 
方法 。 振 动 元 素 如 压 电 材料 和 小 音 圈 电 动机 要 比 动 觉 
设备 的 执行 器 更 轻 ， 通常 可 以 将 其 添加 到 动 觉 设备 
上 ， 它 对 现 有 机 构 的 影响 较 小 。 另 外 ， 高 带宽 动 觉 显 
示 可 以 通过 他 们 的 标准 执行 器 编程 来 显示 开 环 振动 。 
人 体 振动 的 灵敏 度 的 感应 范围 从 直流 到 1kHz 以 上 ， 
峰值 灵敏 度 大 约 在 250Hz。 

我 们 首先 考虑 使 用 振动 来 传递 事件 的 冲击 和 接 
触 一 一 这 一 方法 横 跨 动 觉 (肌肉 运动 知觉 的 ) 反馈 
和 触觉 反馈 。 当 人 们 接触 环境 时 ， 艇 入 在 皮肤 内 的 快 
速 运动 感知 器 记录 这 种 微小 的 产生 于 这 种 互动 中 的 振 
动 。 如 30.3 节 所 述 ， 触 觉 显示 的 传统 方法 通常 包括 
用 一 个 简单 几何 结构 的 一 个 虚拟 模型 ， 然 后 用 一 阶 刚 
度 控制 理论 模拟 表面 。 然 而 这 样 的 一 阶 模型 往往 缺少 
高 阶 效果 如 冲击 的 真实 效果 。 利 用 一 般 的 触觉 泻 染 算 
法 ， 表 面 显得 湿 软 或 不 真实 的 光滑 。 为 了 提高 在 这 种 
环境 中 的 真实 性 ， 一 种 解决 方法 是 增加 高 阶 效 应 ， 如 
纹理 和 接触 振动 。 这 些 效果 可 以 用 一 个 基于 现场 动态 
分 析 描 述 的 表面 模型 库 进行 分 析 说 明 '*”]， 其 有 时 
采用 定性 操作 者 反馈 ,物理 测量 (从 经 验 数据 产生 
的 逼真 模型 )5? 5， 或 者 这 两 者 的 结合 来 调 
3k057— Le ee d HIP 与 虚拟 物体 表面 进行 瞬时 碰 
撞 时 ， 表 面 模型 库 就 会 产生 一 个 适当 的 波形 ， 该 波形 
根据 运动 情况 进行 大 小 缩放 (如 速度 和 加 速度 ) ， 最 
后 通过 一 个 执行 器 开 环 输出 。 执 行 器 可 同时 显示 同一 
个 较 低 频 的 力 的 信息 ， 如 图 30. 10 所 示 。 或 者 它 可 能 


是 一 个 独立 的 变换 器 。Kuchenbecker ^ A7 9! 25 JE JH 
触觉 设备 的 动力 学 来 显示 可 能 的 最 准确 的 振动 波形 ， 
比较 了 大 量 不 同 振动 波形 产生 方法 意欲 传递 响应 释 加 
作用 到 虚拟 环境 的 力 反馈 。 大 多 数 振动 反馈 方法 表现 
类 似 于 现实 情况 ， 比 起 仅 靠 传统 的 力 反 馈 方法 它们 更 


ac A 


n 
A 
时 间 
A 成 比例 
n eA 


时 间 


图 30. 10 ”事件 触发 的 开 环 力 信号 叠加 在 传统 的 基于 活 
透 的 反馈 力 上 提供 振动 反馈 ， 从 而 在 虚拟 环境 中 改善 了 
硬 表面 的 真实 性 ( 经 许可 引 自 参考 文献 [30.60] ) 


振动 反馈 还 可 以 用 来 提供 有 关 图 案 的 纹理 、 粗 粮 
度 和 有 明显 振动 信号 的 其 他 现象 的 信息 。 这 种 类 型 的 
振动 反馈 被 称 为 振动 触觉 反馈 。 在 远程 控制 环境 中 ， 
Kontarinis 和 Howet*”s1 提 出 可 以 通过 振动 反馈 确定 球 
轴承 的 受 损 程 度 。Dennerlein 等 人 ”根据 水 下 机 器 
人 的 远程 操作 任务 实验 ,证明 有 振动 反馈 的 机 器 人 性 
能 比 没有 振动 反馈 的 性 能 好 。 在 这 些 远程 操作 系统 
中 ， 振 动感 知 传感器 ， 如 一 些 加 速度 计 和 压 电 式 传 感 
带 被 用 来 拾取 振动 ， 在 大 多 数 情况 下 将 振动 信号 直接 
作为 输入 传 给 振动 触觉 执行 器 。0kamura AS? 
给 出 了 在 虚拟 环境 中 基于 纹理 和 膜 穿 刺 的 振动 模型 。 
和 上 文 提 到 基于 事件 的 触觉 设备 类 似 ， 振动 波 形 的 建 
模 是 基于 先期 实验 ， 并 且 以 开 环 方式 体现 在 虚拟 环境 
交互 中 。 

最 后 ， 振 动 反 馈 可 以 作为 一 种 感知 替代 方法 ,来 
传递 方向 ， 注 意 力 或 者 其 他 信息 “1 。 在 这 种 应 
用 中 ， 所 关注 的 是 信号 的 强度 和 清晰 度 ， 而 不 是 其 现 
实感 。 接 近 人 灵敏 度 峰值 的 振动 频率 是 最 有 效 的 ， 适 
应 这 些 应 用 的 振动 触觉 执行 器 (接触 器 ) 有 市 售 ， 
如 Engineering Acoustic 公司 的 C2 Tactor 9 97 。 接 触 器 
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阵列 中 的 单元 可 以 选择 性 地 打开 和 关闭 ， 以 产生 感觉 
跳跃 现象 ， 在 这 个 现象 中 接触 器 阵列 脉冲 不 是 在 不 同 
位 置 的 连续 拍打 ， 而 是 以 皮肤 上 经 过 或 跳 过 的 轻 拍 的 
形式 被 感知 的 。 


30.5.2 ”接触 定位 、 滑 动 和 剪 切 力 的 显示 


在 有 关机 器 人 灵巧 操作 的 早期 工作 中 发 现 ， 机 顺 
人 的 手 和 所 抓 取 物 体 之 间 的 接触 点 对 操作 而 言 是 至 关 
重要 的 。 如 果 没 有 这 些 知 识 ， 机 器 人 将 会 由 于 抓 取 误 
差 的 快速 累积 而 扔 下 物体 。 在 许多 机 器 人 研究 者 和 一 
些 公司 开发 出 的 触觉 阵列 传感器 能 够 测量 接触 位 置 、 
压力 分 布 和 局 部 物体 的 几何 形状 (第 19 章 ) 的 同 
时 ， 用 以 展现 这 些 信息 给 一 个 虚拟 或 远程 操作 环境 中 
的 人 工 操作 者 的 实际 方法 已 证 明 相 当 困难 。 通 过 考虑 
接触 位 置 、 滑 动 和 剪 切 力 的 显示 ,我们 开始 接触 显示 
的 讨论 ， 它 们 有 具有 的 共同 目标 是 对 单一 区 域 ， 就 是 皮 
肤 (几乎 常常 在 手指 上 )， 接 触 的 运动 显示 。 对 显示 
接触 信息 ， 应 用 触 针 阵列 的 上 升 和 下 降 对 皮肤 产生 压 
力 分 布 是 迄今 为 止 最 流行 的 方法 ， 而 我 们 在 下 面 一 节 
关于 局 部 形状 中 将 阐述 这 种 设计 ， 因 为 他 们 主要 的 优 
点 是 空间 分 布 信息 的 显示 。 相 反 ， 这 里 我 们 将 重点 放 
在 一 些 专业 触觉 设备 上 ， 这 些 设 备 专门 用 来 解决 接触 
的 定位 与 运动 。 

作为 一 个 接触 位 置 显示 的 例子 ，Provancher 等 
人 中 研制 了 一 个 系统 让 其 再 现在 用 户 指 尖 移动 的 


以 提供 有 关 预 滑动 条 件 的 信息 。 例 如 ，Tsagarakis 等 
他 下 研制 了 一 种 利用 V 结构 的 微型 电动 机 提供 在 
操作 者 指 尖 的 相对 横向 运动 (方向 和 速度 ) 的 感觉 。 
二 维 滑动 / 拉 伸 可 以 通过 协调 两 个 电动 机 的 转速 和 方 
向 来 生成 。 

TPaD (触觉 模式 演示 ) 是 一 种 新 疾 的 可 以 利用 
滑动 和 摩擦 来 显示 触觉 感知 的 装置 。 平板 在 超 
声波 频率 上 的 低 振幅 振动 可 以 产生 一 个 板 和 触 碰 板 的 
人 的 手指 之 间 的 空气 腊 ， 从 而 减少 摩擦 。 人 不 能 感知 
到 板 的 33kHz 频率 的 振动 。 摩 擦 的 减 小 量 随 振 幅 的 不 
同 而 变化 ， 从 而 使 得 在 摸索 时 手指 上 剪 切 力 得 到 间接 
控制 。 手 指 的 位 置 和 速度 反馈 使 得 对 空间 质感 的 触觉 
再 现成 为 可 能 。 


30.5.3 局 部 形状 


大 多 数 显 示 局 部 形状 的 触觉 设备 ， 是 由 一 系列 独 
立 的 针 的 阵列 组 成 ， 这 些 针 可 以 治 表面 法 向 移动 。 通 
常 ， 有 一 层 弹 性 材料 可 覆盖 针头 ， 这 样 操作 者 接触 到 
的 是 一 个 光滑 的 表面 而 不 是 直接 与 针 本 身 接触 。 也 有 
其 他 一 些 系统 利用 独立 单元 的 横向 移动 ， 另 一 些 用 电 
极 替 代 移 动 部 分 形成 电 皮 肤 元 素 的 和 矩阵。 许多 研究 者 
利用 心理 物理 学 和 知觉 的 实验 结果 定义 设计 参数 ， 如 
针 的 数目 、 间 距 和 基于 针 的 触觉 显示 的 振幅 。 一 个 常 
用 的 指标 是 两 个 点 的 区 分 测试 ， 以 获得 为 在 皮肤 上 两 
个 接触 点 被 感知 为 两 个 点 而 不 是 一 个 点 之 间 的 最 小 距 


接触 质心 的 位 置 。 接 触 元 件 是 一 个 自由 滚动 的 圆柱 
体 ， 通 常 离开 指 尖 悬 挂 ， 但 是 当 操 作者 推 一 个 虚拟 


离 。 这 个 区 分 限制 在 身体 不 同 部 位 的 皮肤 上 大 小 是 不 
同 的 ， 指 尖 具 有 最 小 的 距离 (通常 被 认为 小 于 Imm, 


物体 时 它 便 会 接触 皮肤 。 在 皮肤 上 圆 简 的 运动 是 用 
带 套 的 推拉 线 来 控制 的 。 这 样 就 可 以 把 执行 咒 置 放 
在 远 处 ， 接 触 显示 本 身 做 成 一 个 轻 的 、 项 针 大 小 的 
部 件 ， 它 可 以 灵巧 地 安装 在 动 觉 触觉 设备 上 。 实 验 
证 明 ， 在 物体 曲率 区 分 的 任务 中 ， 人 操作 者 在 真实 
操作 和 虚拟 操作 中 执行 的 操作 是 相似 的 。 此 外 ， 操 
作者 能 用 该 设备 区 分 滚动 操作 和 虚拟 物体 绕 定 点 的 
旋转 操作 。 

人 类 在 操作 任务 中 广泛 利用 滑动 和 初始 滑 
5357 9!. 为 了 要 重 现 这 些 现象 ,试验 刻画 人 对 滑动 
的 感觉 研究 者 设计 了 一 个 独立 的 一 个 自由 度 的 滑动 
te BO?) Webster 等 人 号 中 设计 了 两 自由 度 
的 触 党 请 动 显 示 ， 它 使 用 了 一 个 装 在 用 户 指 尖 下 面 的 
驱动 旋转 球 。 这 样 一 个 轻 的 模块 触觉 显示 可 以 附 在 多 
自由 度 的 动 觉 界面 用 来 显示 有 防滑 功能 的 虚拟 环境 。 
实验 结果 表明 ， 与 通常 仅 用 力 反馈 的 方法 比较 ， 可 以 
用 较 低 的 力 通过 结合 滑动 和 力 反 馈 来 完成 一 个 虚拟 操 
作 任 务 。 皮 肤 拉 伸 也 可 以 与 滑动 显示 相 结 合 ， 从 而 可 


虽然 这 取决 于 接触 点 的 形状 和 大 小 ) P9778. Moy 等 
人 所 四 基于 预测 皮下 应 变 ， 和 基于 心理 物理 学 实验 
所 测量 的 幅度 分 辨 率 ， 剪 切 力 的 影响 以 及 黏 弹性 
( 蠕 变 和 松弛 ) 对 静态 触觉 感知 的 影响 ， 量 化 了 人 类 
触觉 系统 的 几 个 感知 能 力 。 他 们 发 现 10% 的 幅度 分 
辩 率 对 于 一 个 有 2mm 的 弹性 层 和 2mm 间隔 的 触觉 传 
感 器 的 远程 控制 系统 就 足够 了 。 一 个 不 同类 型 的 实验 
检验 与 特定 应 用 相关 的 不 同 种 类 的 触觉 信息 。 例 如 ， 
Peine 和 Howe 9 751 发 现 检 测 到 的 手指 垫 的 变形 ， 而 非 
压力 分 布 ， 原 因 在 于 软 材 料 里 局 部 的 肿块 ， 如 组 织 
的 肿瘤 。 

我 们 将 重点 放 在 几 种 个 性 鲜明 的 阵列 式 触觉 显 
示 器 的 设计 上 。 大 量 执行 器 技术 已 经 用 来 进行 开发 
触觉 阵列 ， 包 括 压 电 、 形 状 记 忆 合金 (SMA) 、 电 
磁 、 和 气动、 电流 变 、 微 机 电 系统 (MEMS) 和 电 触 
觉 的 技术 。 想 进一步 了 解 关 于 触觉 显示 设计 和 了 驱 
动 , 可 以 阅读 一 些 综述 性 文章 ， 如 参考 文献 
[30. 80-85], 
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我 们 首先 将 考虑 基于 触 针 方法 的 复杂 性 /成 本 谱 
图 的 两 端 。Killebrew SEAD 在 神经 科学 实验 中 研制 


独立 的 执行 器 的 力 提 供 足 够 的 皮肤 垫 的 运动 / 拉 伸 
以 激发 机 械 感受 器 。 先 导 测试 表明 ， 受 试 者 


了 一 个 400 个 触 针 ，lcm? 的 触觉 模拟 器 来 展现 任意 
时 空 对 皮肤 的 刺激 。 每 个 触 针 是 在 独立 计算 机 控制 
下 ， 每 分 钟 可 以 产生 超过 1200 次 刺激 。 由 于 执行 器 
的 大 小 和 重量 对 于 大 多 数 触觉 应 用 是 不 切实 际 的 ， 它 
是 迄今 为 止 分 辨 率 最 高 的 触觉 显示 设备 ， 并 且 可 以 用 
来 估算 低 分 辨 率 显 示 潜 在 设计 。Wagner 等 人 ”1 利 
用 市 售 伺服 电动 机 构建 了 一 个 36 £F, Lem? 的 触觉 形 
状 显 示 。 这 一 显示 需 最 高 频率 为 7.5 ~25Hz， 这 取决 
于 触 针 的 偏转 量 ， 如 图 30.11 所 示 。Howel 等 
人 59 开发 了 形状 记忆 合金 的 触 针 应 用 到 远程 


触 诊 o 


图 30. 11 a) 一 个 低 成 本 36 针 触 党 显示 用 无 线 控 制 
的 伺服 电动 机 执行 器 b) 近 距 离 显示 6 x6 阵列 ， 
展示 正弦 栅 格 (经 许可 引 自 参 考 文献 [30.79] ) 


与 垂直 于 表面 的 触 针 形成 鲜明 对 照 ， 最 新 的 
触觉 阵列 设计 中 采用 了 横向 移动 的 触 针 。 这 种 结 


可 以 检测 到 虚拟 的 线 ， 这 条 线 是 随机 放 在 虚拟 光 
滑 平 面 上 的 ,该 设备 也 已 经 作为 一 种 盲文 显 
示 2 得 到 测试 。 另 一 个 横向 拉 伸 显示 及 其 评价 
在 参考 文献 [30.93] 中 介绍 。 其 他 触觉 显示 的 新 
颖 方法 ,还 包括 使 用 电 皮 肤 阵列 通过 向 皮肤 或 者 
舌头 发 送 小 电流 艇 ”和 应 用 空气 压力 的 方法 刺 
RJE W AY LR OOP 。 


温度 


由 于 人 体 通常 比 环境 中 的 物体 温度 高 ， 热 的 感觉 
是 基于 热传导 、 热 容量 和 温度 的 综合 。 这 使 得 我 们 不 
仅 可 以 推断 出 温差 .也 可 以 推断 出 材料 组 成 ”|。 
大 多 数 热 的 显示 设备 都 是 基于 热电 冷却 器 ， 也 被 称 为 
HAAR (Peltier) 热 汞 。 热 电 冷 却 器 由 一 系列 的 半 导 
体 接 头 组 成 ， 这 些 接头 电 连 接 串 联 和 热 连 接 并 联 。 热 
电 冷 却 器 被 设计 成 将 热量 从 一 个 陶瓷 面板 抽送 到 男 一 
个 ,但 如 果 反 向 使 用 ,设备 的 温度 梯度 会 成 比例 地 产 
生 电 动 势 ， 作 为 一 个 相对 温度 变化 的 度量 。 触 觉 热 显 
示 的 设计 大 多 使 用 现成 的 组 件 ， 它 们 的 应 用 通常 都 是 
明确 的 ， 即 通过 它们 的 温度 和 热传导 识别 虚拟 或 者 远 
程 操作 环境 中 的 对 象 。 

Ho 和 Jonest 思 ?1 对 触觉 温度 显示 进行 了 概述 ， 而 
且 展 望 了 一 个 令 人 鼓舞 的 结果 : 当 视 觉 线 索 受 限制 的 
情况 下 ， 热 显示 能 够 有 助 于 对 象 的 识别 。 许 多 系统 已 
经 将 热 显 示 和 其 他 类 型 的 触 党 显示 集成 起 来 了 ， 但 是 
由 Caldwell 等 ”3 设计 的 数据 手套 输入 系统 是 第 一 
个 这 样 做 的 。 他 们 的 触 党 界面 同时 提供 了 力 ， 触 党 和 
热 反馈 。 用 于 热 显示 的 Peltier 设备 与 食指 的 背面 接 
触 。 受 试 者 仅仅 依靠 热 的 线索 来 识别 物体 ， 如 冰 块 、 
焊接 钢 、 绝 缘 泡 沫 和 铝 块 ， 并 取得 了 90% 的 成 功率 。 
对 人 体温 度 感知 的 研究 ， 包 括 一 些 问题 如 空间 总 和 与 
温度 显示 的 心理 关联 等 ， 非 常 有 趣 。 例 如 ， 在 假 胶 
中 ， 温 度 显示 可 能 不 仅仅 对 于 一 些 实际 考虑 ， 如 安全 
和 材料 识别 有 用 ， 对 贴身 舒适 的 考虑 可 能 也 有 用 ， 如 
感觉 到 亲人 的 手 的 温暖 。 


30. 5.4 


30.6 结论 与 展望 


触觉 技术 ， 试 图 提供 在 虚拟 和 远程 控制 环境 中 进 


构 首 先是 由 Hayward 和 Cruz- Hernandez? 9! 采用 ; 


最 新 的 设计 使 用 了 一 个 6 x10 EE XM dà Hr AT RS 
阵列 ， 具 有 1. 8mm x 1. 2mm 的 空间 分 辨 率 ， 是 一 
种 紧凑 ， 轻 量 级 ,模块 化 设计 ”的 设备 。 各 个 


行人 工 操作 的 令 人 信服 的 感觉 ， 是 一 种 相对 较 新 的 技 
术 ， 但 同时 也 是 发 展 最 快 的 技术 。 这 个 领域 不 单 将 机 
器 人 学 和 控制 理论 作为 根本 基础 ， 还 得 益 于 人 文科 学 
领域 ， 特 别 是 神经 科学 和 心理 学 。 迄 今 为 止 ， 触 觉 在 
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娱乐 、 医 疗 模拟 和 设计 等 领域 在 商业 上 取得 了 很 大 成 The contribution of muscle afferents to kinesthesia 
Ree dus pia T" shown by vibration induced illusions of movement 
劝 ， 新 设备 和 新 应 用 不 断 出 现 。 an the effects of paralysing joint afferents，Brain 
有 很 多 书籍 是 关于 触觉 技术 的 ， 其 中 很 大 一 部 分 95, 705-748 (1972) 
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本 章 主 要 从 控制 的 角度 对 遥 操 作 机 器 人 领域 的 
研究 进行 综述 。 通 过 对 该 领域 研究 历史 的 回顾 以 及 
应 用 前 景 的 展望 ， 将 其 控制 结构 进行 分 类 并 作 简 要 
介绍 。 然 后 重点 介绍 目前 研究 的 热点 领域 一 一 双向 
控制 和 力 反 馈 控 制 。 最 后 列 出 参考 文献 ， 以 对 遥 操 


作 机 器 人 领域 作 全 面 了 解 。 
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然而 ， 对 于 操作 者 与 机 器 人 处 于 同一 房间 ， 二 者 
物理 距离 很 短 的 情况 ， 遥 操作 机 囊 人 系统 通常 至 少 要 
在 概念 上 分 为 两 个 站 点 : 本 地 站 点 ， 包 括 操作 者 以 及 


和 遥 操作 机 器 人 或 许 是 机 器 人 领域 最 早 的 研究 方向 
之 一 。 字 面 解释 为 远 距离 的 机 器 人 ， 但 通常 是 指 有 操 
作者 控制 的 或 是 人 在 控制 环 中 的 机 器 人 。 用 户 对 规划 
层 、 认 知 层 等 系统 高 层 进 行 决策 ， 而 机 器 人 只 负责 机 
械 实现 。 实 质 上 ， 相 当 于 大 脑 与 身体 分 离 或 是 远离 。 
“tele” 源 于 希腊 语 ， 意 思 为 远 距 离 的 ， 在 遥 操 
作 机 器 人 中 用 来 指 用 户 和 任务 环境 之 间 存 在 障碍 。 通 
过 远 距 离 控制 任务 环境 中 的 机 器 人 来 殉 服 此 障碍 ， 如 
图 31.1 所 示 。 除 了 指 距离 ， 障 碍 也 可 以 是 危险 的 或 
很 大 、 很 小 的 任务 环境 。 所 有 障碍 的 共同 点 是 用 户 无 
法 (或 不 会 ) 与 任务 环境 有 物理 接触 。 


zd 本 地 
感觉 一 触觉 装置 控制 
ae 措施 


fee PUTER 


Bl 31.1 3x BRÁEULSR AREE (来 源 于 参考 文献 [31.11]， 
改编 自 参考 文献 [31.2] ) 


所 有 用 来 与 操作 者 进行 系统 连接 的 必要 部 件 ， 如 操纵 
杆 、 监 视 器 、 键 盘 或 其 他 输入 /输出 设备 ; 远程 站 点 ， 
包括 机 器 人 以 及 相应 的 传感器 和 控制 部 件 。 

为 实现 遥 操 作 功 能 ， 遥 操作 机 器 人 融合 了 机 器 人 领 
域 许 多 方面 的 研究 。 系 统 通过 操作 远程 站 点 的 机 器 人 以 
及 执行 用 户 指 令 来 控制 机 器 人 的 运动 和 /或 受 力 。 参 见 
第 6 章 和 第 7 章 的 详细 介绍 。 力 传感器 (第 19 章 ) 以 
及 其 他 传感器 (第 3 篇 ) 也 极为 重要 (第 4 章 )。 此 外 ， 
本 地 站 点 信息 通常 为 触觉 信息 (第 30 章 ) 。 
近期 遥 操 作 机 器 人 开始 采用 计算 机 网 络 进 行 站 点 
间 的 信息 传送 。 第 32 章 对 该 内 容 进行 了 详细 介绍 并 
提出 新 的 控制 结构 。 例 如 ， 一 个 机 器 人 可 能 由 多 用 户 
共同 控制 或 一 个 用 户 控制 多 个 机 器 人 。 由 于 网 络 接口 
可 从 任意 需要 的 地 点 接 入 ， 因 而 简化 了 以 上 控制 过 
程 。 本 章 主 要 介绍 可 进行 连续 通信 及 操作 的 点 对 点 式 
结构 。 
第 33 章 中 还 指出 了 到 操 作 机 器 人 和 操作 者 肢体 
之 间 的 联系 。 操 作者 肢体 由 操作 者 控制 ， 因 此 用 户 面 
临 着 任务 规划 以 及 其 他 高 层 任务 的 挑战 ， 其 控制 系统 
与 遥 操 作 机 器 人 有 许多 相同 之 处 。 然 而 ， 其 本 地 站 点 
和 远程 站 点 均 位 于 外 骨髓 中， 就 如 同 用 户 与 机 器 人 进 


"d 
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行 直接 的 接触 和 交互 。 本 章 不 考虑 上 述 连接 方式 。 

操作 者 的 存在 使 各 操作 机 器 人 能 够 处 理 未 知 的 且 
无 特定 结构 的 任务 环境 。 其 应 用 领域 (第 6 篇) 有 
航空 航天 (5845 章 )， 和 危险 的 任务 环境 (第 48 章 ) ， 
搜救 现场 (第 50 3€), ， 医 疗 系统 (第 52 章 ) 以 及 康 
复 系统 (第 53 章 ) 。 


统 作为 用 户 与 远程 任务 环境 交互 的 平台 ,理想 情况 下 
用 户 甚 至 忘记 了 平台 的 存在 。 这 样 我 们 称 该 主 从 系统 
是 透明 的 。 

本 章 在 介绍 各 种 系统 控制 结构 之 前 ， 对 遥 操作 机 
器 人 系统 的 硬件 和 系统 实现 进行 检验 。 重 点 介绍 双边 
主 从 系统 ， 因 为 在 该 系统 中 操作 者 感觉 与 远程 任务 环 


为 便于 后 文 叙述 ， 先 定义 一 些 基 本 术语 。 实 际 
上 ， 遥 操作 和 遥 操 纵 等 术语 均 与 遥 操 作 机 器 人 同 义 。 
只 不 过 遥 操 作 机 器 人 最 为 常用 ， 且 突出 机 器 人 是 由 操 
作者 远程 控制 。 遥 操作 强调 任务 层 操 作 ， 而 遥 操 纵 侧 
重 对 象 层 操纵 。 

和 遥 操 作 机 器 人 可 采用 多 种 控制 结构 。 直 接 控 制 或 
人 工控 制 是 一 种 极端 的 控制 方法 ， 是 指 操作 者 直接 且 
不 借助 任何 自动 控制 设备 来 控制 机 器 人 的 行为 。 另 一 
种 极端 的 控制 方法 为 监督 控制 ， 系 统 高 层 处 理 操作 者 
指令 以 及 反馈 信息 ， 并 对 机 器 人 的 智能 和 /或 自治 性 
有 一 定 要 求 。 介 于 这 两 个 极端 之 间 的 共享 控制 结构 
下 ， 机 器 人 具有 某 种 程度 的 自治 性 或 操作 者 可 利用 自 
动 控制 设备 辅助 控制 。 

实际 的 许多 控制 系统 至 少 在 某 几 个 系统 层 采用 直 
接 控 制 ， 且 用 户 接口 包括 一 个 控制 杆 或 其 他 相似 的 设 
备 以 接收 操作 者 指令 。 由 于 控制 杆 是 机 械 设备 ， 因 此 
可 被 视 为 一 个 独立 的 机 器 人 。 本 地 站 点 和 远程 站 点 的 
机 器 人 分 别 被 称 为 主机 器 人 和 从 机 器 人 ， 相 应 地 称 该 
系统 为 主 从 系统 。 为 实现 直接 控制 ， 操 作者 控制 主机 
器 人 的 运动 ， 然 后 通过 编程 实现 从 机 器 人 跟踪 主机 天 
人 。 通 常 ， 主 机 器 人 (控制 杆 ) 与 从 机 器 人 具有 相 
同 的 运动 形式 ， 且 能 提供 一 个 直观 的 用 户 界面 。 
有 些 主 从 系统 还 可 以 提供 力 反馈 信息 ， 使 主机 需 
人 不 但 能 够 感知 从 机 器 人 的 运动 过 程 ， 还 能 够 将 其 受 
力 信息 反馈 给 用 户 。 这 样 用 户 接口 能 够 进行 双边 通信 
的 系统 称 为 双边 遥 操 作 机 器 人 系统 。 操 作者 与 主机 器 
人 之 间 的 交互 是 操作 者 与 机 器 人 交互 的 一 种 形式 (第 
57 章 )。 在 触觉 学 (第 30 章 ) 中 ,尽管 用 户 与 虚拟 环 
境 而 不 是 远程 环境 对 接 ， 但 也 对 用 户 接口 的 双边 通信 
进行 了 研究 ， 主 要 涉及 运动 信息 和 受 力 信息 的 通信 。 
需要 注意 的 是 ,不 同 的 系统 结构 下 ,运动 和 受 力 信 息 
可 能 是 对 用 户 的 输入 信息 或 是 用 户 的 输出 信息 。 

最 后 ， 讨 论 了 主 从 系统 和 遥 操 作 机 器 人 的 终极 目 
标 一 一 遥 在 。 遥 在 技术 使 用 户 不 但 能 够 操纵 远程 任务 
环境 ， 同 时 还 能 身 临 其 境地 感知 任务 环境 。 通 过 向 操 
作者 提供 足够 的 反馈 和 感官 信息 使 操作 者 仿佛 置身 于 
远程 站 点 。 琐 在 技术 融合 了 触觉 、 视 觉 、 听 觉 、 味 觉 
以 及 嗅觉 感官 信息 。 由 于 触觉 通道 可 由 机 器 人 的 硬件 
及 其 控制 系统 搭建 ， 因 此 本 章 将 做 重点 介绍 。 主 从 系 


T 


境 连 接 最 为 紧密 且 包 含 许多 系统 稳定 性 和 控制 问题 。 


31.2 遥 操 作 机 器 人 系统 及 其 应 用 

遥 操 作 机 器 人 与 移动 机 器 人 、 工 业 机 器 人 以 及 其 
他 大 多 数 机 器 人 一 样 ， 必 须 针 对 特定 的 任务 及 要 求 进 
行 设计 。 因 此 ， 我 们 将 对 系统 针对 不 同 应 用 所 做 的 改 
进 作 一 个 综述 。 先 作 简要 的 历史 回顾 ， 然 后 介绍 各 种 
机 器 人 设计 和 用 户 接口 的 应 用 。 


31.2.1 历史 回顾 


遥 操 作 最 早出 现在 20 世纪 四 五 十 年 代 Raymond 
C. Goertz 的 核 研究 工作 中 。 他 搭建 了 操作 者 可 以 从 保 
护 盾 后 方 处 理 放 射 性 材料 的 保护 系统 。 第 一 代 系 统 是 
由 一 组 选择 开关 控制 电动 机 驱动 以 及 坐标 轴 平 移 的 电 
动 系统 5 。 显 然 ， 操 作 速 度 慢 上 且 不 自然 ,因此 
Goerlz 建 立 了 机 械 连 接 的 主 从 机 器 人 对 。 传 动 装 
置 、 联 动 装置 以 及 电线 的 连接 使 得 操作 者 可 以 通过 这 
些 连接 结构 将 手 的 动作 以 力 和 振动 的 形式 传递 给 从 机 
器 人 ， 但 这 对 操作 者 与 任务 环境 间 的 距离 有 一 定 限 制 
且 要 求 使 用 同 种 运动 器 械 ， 如 图 31. 2 所 示 。Goertz 很 
快 认 识 到 电 耦 合 机 械 臂 的 重要 用 途 ， 并 为 现代 遥 操 作 
机 器 人 和 双向 力 反 馈 位 置 体 服 英 定 了 基础 1。 


图 31.2 20 世纪 50 年 代 Raymond C. Goertz 
使 用 电动 机 械 遥 操作 机 器 人 处 理 放射 性 物质 
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20 世纪 60 年 代 初 ， 时 延 对 遥 操 作 机 器 人 的 影 
响 开 始 成 为 研究 的 热点 号。 监督 控制 2 守 纪 的 引入 
是 为 了 解决 时 延 问 题 ， 同 时 也 启发 了 遥 操 作 机 器 人 
领域 此 后 数 年 的 发 展 。20 世纪 80 年 代 末 90 年 代 
初 ， 引进 了 基于 李 雅 普 诺 夫 稳 定性 分 析 和 网 络 理 
论 3 引 的 控制 方法 。 以 上 方法 的 采用 使 得 遥 操 作 
机 器 人 系统 的 双向 控制 成 为 当今 重要 的 研究 方向 ， 
见 31.4 45, Internet 的 发 展 及 其 作为 通信 平台 的 应 
用 加 速 了 该 方向 的 发 展 ， 同 时 也 引入 了 非 确定 性 时 
延 的 挑战 。 

在 硬件 实现 方面 ， 中 心 研 究 实验 室 于 1982 EF 
发 的 M2 模型 是 首 个 分 离 主 从 电子 设备 实现 力 反 馈 
的 遥 操 作 机 器 人 系统 。 该 模型 由 橡树 岭 国家 实验 室 
共同 研发 ， 曾 被 用 来 进行 多 种 任务 演示 ， 其 中 包括 
军事 、 航 天 或 核 应 用 等 。 美 国 国家 航空 航天 局 
(NASA) 采用 M2 系统 对 ACCESS 太空 机 架 组 装 进 
行 仿真 得 到 了 很 好 的 结果 ( 见 图 31.3)。 由 M2 F 
发 的 高 级 伺服 机 械 手 (ASM) 改进 了 操作 者 的 远程 
维持 性 且 被 认为 是 遥 操 作 机 器 人 系统 的 基础 
ppp, 


BH 


图 31.3 EREDA A ASE CRL M2 模型 
FAFA TARA (1982 ) 


受 核 应 用 的 推动 ， 法 国 CEA 的 Vertut 和 他 的 同事 
发 了 到 操作 双边 伺服 机 械 手 中 。 他 们 借助 


们 开 


MA23 对 遥 操 作 机 器 人 的 操作 进行 了 验证 ， 其 中 包括 
计算 机 辅助 功能 设计 ， 以 改善 操作 者 的 操作 中 。 
辅助 设备 包括 软件 模具 和 固定 装置 或 虚拟 墙 及 约 
AP, 9,31.3.2 节 相 关 介 绍 。 

Bejczy 等 在 喷气 推进 实验 室 (JPL) 研发 了 太空 
应 用 的 双 辟 力 反 馈 愧 操作 机 器 人 系统 。 该 方法 
首次 使 用 了 运动 学 和 动力 学 上 均 不 同 的 主 从 系统 ， 控 
制 域 为 笛 卡 儿 空 间 坐 标 系 。 图 31. 4 所 示 为 带 有 两 个 
后 骑 式 手 控制 器 的 主 控制 站 。 该 系统 用 于 太空 的 遥 操 
作 机 器 人 仿真 。 


图 31.4 JPL ATOP 控 制 站 (20 世纪 80 年 代 早 期 ) 


20 世纪 八 九 十 年 代 由 于 核能 应 用 开始 减少 ， 研 
究 热 点 转向 太空 、 医 疗 以 及 水 下 等 其 他 领域 。 计 算 机 
的 日 益 发 展 及 新 型 手 控制 器 的 出 现 加 速 了 研究 进展 ， 
例如 ，PHANToM 设备 "通过 应 用 于 虚拟 现实 的 触 
觉 系统 而 逐渐 普及 (第 30 F). 

1993 年 ， 携 带 首 个 遥 操 作 机 器 人 系统 的 哥 伦 
比 亚 号 航天 飞机 币 翔 于 太空 执行 德国 太空 实验 室 
D2 号 任务 。 机 器 人 技术 实验 (ROTEX) 验证 了 通 
过 本 地 传 感 反馈 、 预 测 显 示 和 遥 操 作 来 远程 控制 
KAP AC OO! ， 如 图 31.5 所 示 。 由 于 该 实验 中 
的 往返 时 延 为 6~7s， 因 而 无 法 控制 回路 中 加 入 力 
反馈 。 

2001 年 ，Computer Motion 公司 的 首 个 跨 大 西洋 
远程 手术 的 成 功 ,证 明了 遥 操 作 机 器 人 系统 甚至 可 
以 成 功 地 应 用 于 精密 手术 领域 号 2 。 如 图 31.6 所 
示 ， 美 国 纽约 的 外 科 医 生 使 用 ZEUS 系统 为 法 国 斯 
特 拉 斯 保 的 病人 做 腹腔 镜 胆 圳 切除 术 。 由 于 该 系统 
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不 包括 力 反馈 ， 所 以 外 科 医 生 只 能 利用 视觉 反馈 
言 息 。 

以 上 我 们 简要 介绍 的 遥 操 作 机 器 人 系统 ， 是 
和 遥 操 作 机 器 人 发 展 史 上 的 里 程 碑 。 还 有 些 遥 操作 
机 器 人 系统 对 该 研究 领域 也 有 一 定 的 贡献 ， 但 没 
有 提 及 。 


31.2.2 应 用 


危险 环境 中 的 人 身 安 全 问题 ( 如 核 或 化 工 生 产 
过 程 ) ， 到 达 远 程 环 境 的 高 代价 问题 (如 太空 )， 标 
度 问 题 ( 如 功率 放大 或 位 置 调整 的 微 操作 或 微 创 手 
AR) 等 推动 了 还 操作 机 器 人 技术 的 发 展 。 自 遥 操 作 
技术 应 用 于 核 研究 领域 后 ， 遥 操作 机 器 人 系统 就 不 断 
改进 以 适用 于 其 他 领域 的 应 用 。 只 要 是 有 机 融 人 的 地 
方 几乎 都 可 以 发 现 遥 操作 机 器 人 的 身影 。 以 下 是 一 些 
更 振奋 人 心 的 应 用 。 


图 31.5 ROTEX， 首 个 太空 远程 控制 机 器 人 (1993). 
太空 中 的 遥 操 作 机 器 人 及 地 面 操 作 站 


图 31.6 林 德 博 格 手术 一 一 首 例 横 跨 大 西洋 的 遥 操 作 手 术 (2001 ) 


微 创 手术 遥 操 作 机 器 人 减 小 了 手术 切口 ， 相 比 传 
统 的 手术 而 言 减 轻 了 病人 的 创伤 站 2 。 由 Intuitive 
Surgical 公司 研发 的 达 ' 芬 奇 系统 523] ， 如 图 31.7 所 
示 ， 是 目前 唯一 的 商用 设备 。 此 外 ，Computer Mo- 
ton? ?! endo Via Medical?! ， 以 及 华盛顿 大 
BP) AEREO. MEER P 
DE] EH PE PR ELAR A TL Lou T 

遥 操 作 机 器 人 由 于 能 保护 操作 者 不 必 进 入 危险 环境 
而 被 广泛 应 用 于 核 或 化 工 工业 。 操 作者 也 可 以 使 用 遥 操 


作 机 器 人 对 高 压 电力 线路 进行 安全 维修 而 不 必 中 断 输电 
服务 。 排 爆 也 是 其 重要 应 用 之 一 。 图 31.8 所 示 的 远程 排 
爆 及 视察 机 器 人 (tEODor) 或 iRobot 生产 的 Pack- 
Bot? 3 常 被 警察 和 军队 用 来 排 雷 或 排除 其 他 易 爆 物品 。 


此 外 ， 远 程控 制 工具 车 被 用 于 灾区 的 搜救 中 31 


距离 障碍 的 存在 使 得 太空 机 器 人 成 为 般 操 作 机 器 


人 的 经 典 应 用 领域 ， 参 见 第 45 章 。 美 国 宇航 局 火 上 


车 是 一 个 成 功 的 例子 。 由 于 存在 几 分 钟 的 时 延 ， 因 此 
火星 车 采用 监督 控制 ， 即 火星 车 通过 直接 传 感 反馈 获 
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得 局 部 自治 ,以 完成 操作 者 预先 制定 的 目标 
3a. 

德国 技术 试验 ROKVISS (机 器 人 国际 空间 站 组 
件 核查 ) 的 轨道 机 器 人 是 最 先进 的 遥 操 作 机 器 人 系 
HU. T 2004 年 安装 在 国际 空间 站 俄罗斯 舱 外。 
该 实验 在 真实 的 太空 环境 下 验证 了 带 力矩 传 感 和 立体 
摄像 机 的 高 级 从 机 器 人 系统 部 件 。 由 于 国际 空间 站 和 
位 于 德国 航空 局 的 操作 站 之 间 存 在 通信 连接 ， 时 延 减 
少 到 20ms 左右 ， 因 而 可 以 采用 带 高 保 真 力 反馈 的 双 
向 控制 结构 S31 ( 见 图 31.9)。 该 技术 引领 了 卫星 服 
务 机 器 人 的 发 展 ， 名 为 Robonauts 的 机 器 人 可 通过 地 
面 进 行 远程 操作 来 协助 宇航 员 舱 外 活动 (EVA) 或 
完成 维修 工作 55 。 


2 


图 31.7 Intuitive Surgical 公司 研发 的 用 于 
微 创 手术 的 达 … 芬 奇 系统 


图 31.8 tEODor, FATHER AYER EBLE A BSE 


图 31.9 ROKVISS， 能 向 地 面 操作 者 提供 立体 视觉 和 
触觉 反馈 信息 的 遥 操 作 机 器 人 系统 


31.3 控制 结构 

相 比 一 般 的 机 器 人 系统 中 机 器 人 只 执行 用 户 预 先 
设 定 的 运动 或 程序 而 不 顾 用 户 或 操作 者 的 后 续 操 作 ， 
遥 操 作 机 器 人 系统 既 向 用 户 提供 信息 ， 同 时 也 接受 用 
户 指 令 。 如 图 31. 10 所 示 ， 遥 操作 机 器 人 的 控制 结构 
可 通过 控制 方法 和 连接 层 来 描述 。 主 要 分 为 三 类 : 直 
接 控制 ， 共 享 控制 ， 监 督 控制 。 实 际 上 ， 一 般 控 制 结 
构 为 以 上 三 种 控制 策略 的 融合 。 

直接 控制 表明 系统 不 具备 智能 和 自治 ， 因 而 用 户 
通过 主 接口 直接 控制 从 机 器 人 的 运动 。 如 果 通 过 直接 
控制 ， 结 合 本 地 传 感 和 自治 来 完成 任务 ， 或 者 用 户 反 
馈 通 过 虚拟 现实 或 其 他 自动 化 辅助 设备 进行 放大 ， 这 
样 的 控制 结构 称 为 共享 控制 。 监 督 控制 下 用 户 与 从 机 
器 人 连接 松散 ， 因 而 从 机 器 人 具有 很 强 的 局 部 自治 能 
力 ， 例 如 操作 者 发 送 高 层 指令 ， 遥 操作 机 器 人 提取 指 
令 并 执行 。 下 面 从 监督 控制 开始 对 各 种 控制 结构 进行 
介绍 ，31.3.3 节 详 细 介绍 了 直接 控制 和 双边 控制 ， 
为 31.4 节 奠 定 基础 。 


监督 控制 


Ferell 和 Sheridan 于 1967 年 介绍 了 监督 控制 3 站 5 
受 启 发 于 对 监督 下 属 工作 人 员 的 模拟 。 监 督 者 向 机 顺 
人 发 出 高 层 指令 ， 并 接受 来 自 于 机 器 人 的 综合 信息 。 
Sheridan 通过 对 比 人 工 操作 和 自动 控制 对 该 方法 进行 
THRO), “操作 者 间隔 地 进行 程序 设 定 ， 并 不 间 
断 地 从 电脑 接收 信息 ， 而 电脑 可 通过 智能 效应 顺和 传 
感 器 关闭 自治 的 控制 回路 。 

目前 ， 远 程 自治 控制 回路 都 被 切断 ， 只 将 状态 和 
模型 信息 传送 给 操作 者 站 点 。 操 作者 监督 遥 操 作 机 器 
人 系统 并 做 决策 。 下 面 介 绍 监督 控制 的 特殊 实现 方 
法 一 一 远程 传感器 编程 。 

远程 传感器 编程 (TSP) 是 一 个 共享 自治 的 概 
念 ， 人 与 机 器 共享 智能 ”…”: 。 假 定 传 感 系统 能 为 实 
时 任务 环境 提供 足够 的 信息 ， 机 器 层 便 可 独立 执行 部 


31.3.1 
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分 任务 。 任 务 规 划 层 的 配置 和 决策 则 由 操作 者 完成 。 ” 编程。 并非 在 关节 或 笛 卡 儿 操 作 层 对 机 器 人 系统 进行 
局 部 传 感 反馈 回路 供 机 器 人 系统 利用 ， 而 全 局 任务 层 。 示 教 ,而 是 在 更 高 的 语言 层 ， 如 操作 者 可 在 该 层 对 机 
必须 与 操作 者 交互 控制 。 该 共享 自治 的 方法 是 TSP 器 人 进行 行为 规划 ， 机 器 人 系统 可 在 没有 操作 者 介入 
的 基础 ， 可 用 此 方法 对 机 器 人 进行 任务 导向 层 的 远程 ” 时 独立 完成 该 行为 。 


(多 模式 ) 人 一 机 接口 
RERE 视觉 显示 


监督 控制 
=] 局 部 自治 
直接 控制 感应 装置 appe 
应 装置 ”触觉 装置 ”远程 传感器 编程 
单 向 指令 E 
双向 控制 “~ 


f 
&4 — BA — fee. 


遥 操 作 机 器 人 PRE ALAA, 遥 操 作 机 器 人 


图 31. 10 迁 操 作 机 器 人 系统 不 同 的 控制 结构 


图 31. 11 所 示 为 TSP 实现 的 结构 ， 由 两 个 并 行 工 。” 立 了 一 个 与 真实 系统 结构 大 致 相同 的 仿真 环境 ， 与 真 
作 的 控制 回路 组 成 。 其 中 一 个 回路 控制 真实 (和 远程》 ” 实 系统 有 一 些 区别 。 
系统 ， 包 含 内 部 反馈 以 形成 局 部 自治 。 另 一 个 回路 建 


图 形 和 动画 
局 部 自治 循环 
预测 控制 " 
机 器 人 传感器 


(本 地 ) 
仿真 


循环 


下 看 模型 传感器 
TT : 
ARIS wi 任务 规划 和 路 径 规 划 “| | | oc ARMARE NE 
错误 处 理 和 参数 测定 Pyrenean ”世界 模型 的 先 验 
ISI 知识 更 新 知识 运用 


实际 系统 
控制 循环 


局 部 自治 循环 


图 31. 11 远程 传感器 编程 在 ROTEX 任务 中 的 实现 
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最 重要 的 一 点 是 ， 任 何 通信 时 延 信 号 传送 至 远程 
系统 ， 如 太空 系统 ， 在 仿真 环境 中 该 信号 不 会 被 复 
制 。 因 此 ， 相 对 于 真实 系统 ， 仿 真 环境 具有 预测 功 
能 。 第 二 点 ， 真 实 系统 无 法 观测 内 部 变量 ， 仿 真 系统 
则 可 以 显示 内 部 变量 ， 使 操作 者 或 任务 规划 者 可 以 更 
直观 地 了 解 系统 接受 指令 后 所 作 的 反应 。 两 个 回路 通 
过 一 个 通用 的 模型 数据 库 进行 通信 ， 将 任务 执行 的 先 
验 知识 传递 给 远程 系统 ， 然 后 将 后 验 知识 用 于 仿真 环 
境 的 模型 更 新 。 为 实现 这 样 一 个 遥 操 作 机 器 人 控制 系 
统 的 功能 ， 需 要 借助 特殊 的 工具 。 首 先 要 建立 一 个 能 
够 对 真实 机 器 人 系统 进行 模拟 的 复杂 的 仿真 系统 。 其 
中 包括 在 真实 环境 中 的 传 感 感知 仿真 。 此 外 ， 共 享 自 
治 的 概念 必须 能 够 提供 一 个 有 效 的 操作 接口 以 建立 任 
务 描 述 ， 配 置 任务 相关 变量 ， 选 择 传感器 和 控制 算 
法 ， 调 试 整个 任务 运行 。 

在 有 大 时 延 的 遥 操 作 机 器 人 系统 ， 如 太空 和 水 下 
用 中 ， 基 于 传 感 信息 的 任务 编程 方法 "具有 一 
的 优势 。 在 视觉 反馈 信息 出 现 几 秒 延 迟 的 情况 下 ， 
于 操作 者 无 法 准确 判断 机 器 人 的 运动 状态 ， 因 而 不 
能 采用 此 方法 。 

ToU jj EC e VE d Re p ue RE ue e IR EOP” 
此 外 ， 通 过 将 手 控制 器 的 受 力 信息 反馈 到 共享 和 遥 操 
作 控 制 模型 2 5 或 预测 仿真 模型 中 可 以 改进 操作 者 
的 操作 。 最 后 ， 交 互 式 监督 用 户 接口 使 配置 环境 变量 
和 控制 参数 成 为 可 能 。 
遥 操 作 机 器 人 系统 的 主要 特点 是 用 包含 传 感 仿真 
的 预测 立体 图 形 取代 时 延 视觉 反馈 ， 提供 监督 控制 技 
术 ， 使 机 器 人 系统 具有 更 高 的 自治 和 智能 。 


共享 控制 


为 实现 远 距离 或 危险 环境 (如 太空 或 外 科 手 术 ) 
下 的 遥 操 作 技 术 ， 引 入 遥 操 作 机 器 人 共享 控制 的 概 
念 2220 可 以 保证 遥 操 作者 和 /或 任务 安全 。 共 享 控 
制 基 于 遥 操 作 机 器 人 站 点 〈 见 图 31.11) 的 局 部 传 感 
反馈 回路 二 2 ， 操 作者 所 有 的 指令 被 自动 提取 且 遥 
操作 机 器 人 具有 一 定 的 传 感 智能 。 操 作者 通过 运动 反 
人 馈 设备 等 发 出 总 路 径 规 划 指 令 ， 然 后 随时 进行 微调 。 

在 具有 大 时 延 的 应 用 环境 下 ， 共 享 自治 概念 是 指 
操作 者 和 远程 机 器 人 均 具 有 一 定 的 智能 ， 从 这 个 意义 
上 说 共享 自治 是 一 个 以 任务 为 导向 的 方法 ，。 操 
作者 和 (自治 的 ) 遥 操 作 机 器 人 共同 控制 任务 的 执 
行 ， 这 就 将 总 任务 分 解 为 许多 的 子 任务 。 如 图 31. 12 
所 示 ， 系 统 的 自治 部 分 控制 并 补偿 病人 的 运动 ， 外 科 
医生 对 一 个 稳定 的 虚拟 病人 进行 手术 操作 。 


Hr BER 


31. 3. 2 


图 31. 12 ”共享 控制 概念 在 遥 操 作 手 术 中 的 应 用 


虚拟 固定 装置 "是 共享 控制 的 一 个 特殊 应 用 。 
将 虚拟 表面 、 导 向 管 等 其 他 部 件 铸 加 到 可 视 和 /或 可 
触摸 的 用 户 屏 上 。 这 些 固 定 装置 可 以 使 操作 者 通过 限 
制 机 器 人 的 运动 范围 和 /或 强迫 机 器 人 沿 期 望 轨迹 运 
动 来 完成 下 操 作 或 机 器 人 辅助 操作 任务 。 主 站 点 的 控 
制 权 共享 是 利用 系统 或 任务 的 先 验 知识 来 修改 用 户 指 
令 和 /或 与 自动 生成 的 控制 信号 进行 结合 来 实现 的 。 
带 固定 设备 的 遥 操 作 机 器 人 系统 由 于 充分 利用 了 
机 器 人 系统 的 准确 性 以 及 与 操作 者 共享 控制 权 ， 因 而 
BERAIR Abbott 等 人 把 共享 控制 比喻 为 
把 普通 的 尺 :“ 与 直接 用 手 画 直线 相 比 ， 用 直 尺 夯 
则 快 得 多 ， 而 且 画 出 的 直线 更 直 。 同 样 的 道理 ， 主 机 
带 人 的 受 力 和 位 置信 息 就 如 同一 把 直 尺 ， 帮 助 操作 者 
MAR” 主机 器 人 和 其 控制 器 的 特性 决定 了 虚拟 固 
定 设备 实际 上 就 如 同 阻抗 或 导 纳 ， 分 别 向 用 户 提供 修 
正 的 受 力 或 位 置信 息 。 而 与 实际 的 物理 固定 设备 不 同 
的 是 ， 辅 助 层 及 辅助 类 型 均 可 由 编程 实现 且 互 不 
相同 。 


31.3.3 直接 和 双向 遥 操 作 


为 了 避免 实现 局 部 自治 的 困难 ， 多 数 遥 操作 机 器 
人 系统 都 采用 了 某 种 形式 的 直接 控制 : 允许 操作 者 规 
划 机 器 人 的 运动 。 以 下 假设 有 一 个 主 从 系统 ， 如 用 户 
手 握 控制 杆 或 者 主机 器 人 等 其 他 输入 设备 。 我 们 首先 
介绍 单 向 控制 ， 然 后 介绍 双向 控制 ， 在 双向 控制 中 主 
机 器 人 充当 显示 设备 。 

1. 单 向 加 速 或 速率 控制 

在 水 下 、 航 空 或 航天 应 用 中 ， 从 机 器 人 可 能 是 一 
个 由 助 推 器 推进 的 小 车 或 飞行 器 。 用 户 通过 控制 助 推 
器 的 供 能 使 其 加 速 称 为 直接 控制 。 在 其 他 应 用 中 ， 用 
户 则 可 能 需要 控制 小 车 或 从 机 器 人 的 速率 或 速度 。 在 
这 两 种 情况 下 ， 输 入 设备 通常 是 以 弹簧 为 中 心 的 控制 
杆 ， 控 制 指令 与 控制 杆 的 位 移 成 正比 。 例 如 ， 用 一 个 
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六 维 空间 鼠标 或 用 两 个 控制 杆 分 别 来 控制 六 自由 度 从 
机 器 人 的 平移 和 旋转 。 

采用 加 速度 和 速度 控制 时 ， 操 作者 要 使 从 机 器 人 
到 达 目 标 位 置 并 且 保持 不 动 不 是 件 容易 的 事 。 显 然 ， 
速度 控制 比 加 速度 控制 的 精确 度 要 高 ”…”“; KRE, 
加 速度 控制 适用 于 二 阶 系统 ， 而 速度 控制 对 一 阶 系统 
的 控制 效果 更 好 。 如 果 从 机 器 人 的 位 置信 息 可 通过 局 
部 回路 进行 反馈 ， 那 么 控制 系统 就 可 以 利用 局 部 反馈 
信息 控制 从 机 器 人 的 位 置 ， 而 不 必 求 解 动态 控制 


c 


问题 。 
2. 位 置 控制 和 运动 耦合 
假设 对 从 机 器 人 采用 位 置 控 制 ， 那 么 接 下 来 就 要 


考虑 主 从 机 器 人 之 间 的 运动 耦合 问题 ， 如 主 从 机 器 人 
的 位 置 映射 。 需 要 强调 的 是 ， 主 机 器 人 和 从 机 器 人 分 
别 在 主 空间 和 从 空间 中 运动 。 主 从 空间 不 完全 相同 。 

(1) Bernie 在 讨论 主 从 机 器 人 的 耦合 方 
式 之 前 ， 需 认识 到 二 者 并 不 是 常常 出 现 耦 合 ， 比 如 ， 
在 系统 运行 之 前 主 从 机 器 人 可 能 被 置 于 不 同 的 初始 位 
置 / 空 间 。 以 下 三 种 方式 可 导致 系统 出 现 耦 合 : 中 使 
主 从 机 器 人 中 的 一 个 或 两 个 运动 到 同一 位 置 ; QAP 


(3) 运动 学 相 异 机 制 ” 很 多 情况 下 ， 主 从 机 咒 
人 并 不 相同 。 考 虑 到 主机 器 人 与 用 户 连接 ， 从 而 进行 
相应 的 设计 。 从 机 器 人 工作 于 某 个 特定 的 任务 环境 ， 
从 而 进行 相应 的 关节 配置 且 决 定 所 需 关节 数目 。 因 
此 ， 机 器 人 通过 关节 连接 很 难 实现 。 

运动 学 相 异 的 机 器 人 在 顶层 进行 连接 。 阁 x 表示 
机 器 人 的 位 置 ， 以 下 等 式 成 立 

Xa =X +X ier Xa =X, -X offset (31.3) 

WAR Lae AR 7r o EAE YER, ALORA Tie Fe 

阵 ， 有 如 下 等 式 


R= RR orice: 

Ra =R RI (31.4) 
其 中 方向 偏 移 定义 为 主 从 机 器 人 间 的 角度 差 。 

Ras =R,R. (31.5) 


如 果 有 需要 ， 可 将 机 器 人 的 速度 和 角速度 进行 互 
连 但 不 一 定 要 有 偏 移 。 

最 后 需要 强调 的 是 ， 多 数 遥 操作 机 器 人 系统 的 远 
程 站 点 使 用 摄像 头 ， 本 地 站 点 则 安装 监视 器 。 为 了 使 
连接 看 起 来 更 为 真实 ， 从 机 器 人 的 位 置 和 方向 是 在 摄 
像 头 的 坐标 空间 中 测量 的 ， 而 主机 器 人 的 位 置 和 方向 


控制 其 中 一 个 机 器 人 运动 到 另 一 个 机 器 人 所 在 的 位 
置 ; @ 减 小 机 器 人 间 的 位 置 偏 移 量 使 二 者 连接 。 

机 器 人 间 建 立 连接 后 ， 也 可 短暂 地 断 开 连接 。 主 
要 因为 : 用 户 可 以 在 不 影响 从 机 器 人 状态 的 情况 下 短 
暂 休 息 ， 且 方便 机 器 人 进行 切换 。 在 主 从 机 器 人 的 工 
作 空 间 没 有 完全 重合 的 情况 下 ， 主 要 是 为 方便 机 器 人 
进行 切换 。 这 就 如 同 将 鼠标 从 鼠标 垫上 拿 起 重新 定 
位 ， 而 不 需要 移动 光标 。 

在 遥 操 作 机 器 人 中 该 过 程 称 为 离合 ， 有 时 也 称 为 
索引 。 如 果 可 以 出 现 离合 ， 或 主 从 机 器 人 的 初始 位 置 
不 一 定 相同 ， 那 么 机 器 人 间 便 可 出 现 位 置 偏 移 。 

(2) 运动 学 相似 机 制 ”最 简单 的 主 从 机 制 为 运 
动 学 相似 机 制 。 这 种 情况 下 ， 主 从 机 器 人 通过 一 个 关 
PAER, q ”代表 关节 和 角度， 下 标 “m” 指 主机 
器 人 ,，“s” 指 从 机 器 人 ,“offset” 表 示 二 者 间 的 位 置 
KE, ‘dO 为 期 望 值 ， 有 如 下 等 式 

Ga =In t das dui 7d. ~ Gora (31.1) 

当主 从 机 器 人 将 要 进行 连接 或 重 连 时 ， 二 者 间 的 

位 置 偏 移 由 下 式 计 算 
dua 7d, 7 d, (31.2) 


值 是 基于 用 户 的 视觉 坐标 系 。 

(4) 标 度 和 空间 映射 ”运动 学 相 异 的 主 从 机 絮 
人 通常 尺寸 也 不 同 。 这 意味 着 离合 时 二 者 的 工作 空间 
要 完全 映射 , 但 同时 也 需要 进行 运动 标定 。 式 
(31.3) 经 标定 后 有 以 下 形式 


(x, = xa) 


Xa 二 Nm FX otter Xma = (31.6) 


然而 ， 机 器 人 的 方向 不 能 进行 标定 。 标 量 人 / 值 的 选取 
依据 为 主 从 空间 的 映射 匹配 程度 ， 或 是 用 户 的 舒适 
程度 。 

如 果 引 入 了 下 文 介绍 的 力 反 馈 ， 就 要 进行 相应 的 
力 标 度 。 通 过 标 度 可 以 防止 远程 任务 环境 变量 出 现 失 
真 ， 如 刚度 或 阻尼 。 

除 线性 标 度 外 ， 对 非 线 性 标 度 或 将 工作 空间 分 解 
的 时 变 映 射 也 进行 了 研究 。 它 们 将 有 效 地 改变 物体 逼 
PEAY p ECHO 或 调整 偏 移 量 以 充分 利用 主 工作 
EXITOSA. 

(5) 局 部 位 置 控制 ”我 们 假设 从 机 器 人 接受 位 
置 控制 指令 。 因 为 需要 一 个 局 部 控制 器 来 控制 从 机 器 
人 的 位 置 。 特 别 是 在 运动 学 相 异 机 制 中 ， 则 是 一 个 带 


大 多 运动 学 相似 的 主 从 系统 两 站 点 工作 空间 相同 
且 不 允许 出 现 离合 ， 因 此 机 器 人 间 的 偶 移 位 置 通常 设 


关节 速度 与 控制 器 结构 有 关 ， 可 由 式 (31.1) 
求 导 得 出 。 关 节 速 度 的 偏 移 则 无 需 定义 。 


有 逆 运 动 学 模型 的 稍 卡 儿 空 间 位 置 控 制 咒 。 详 见 第 6 
章 中 的 介绍 。 

如 果 从 机 器 人 有 元 余 ， 将 采用 自动 控制 或 增加 用 
户 控制 指令 来 优化 某 些 性 能 指标 。 相 应 的 技术 参见 第 
11 章 。 
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31.4 双向 控制 和 力 反 馈 控 制 


为 了 增强 还 在 感 以 及 提高 任务 执行 效率 ,许多 主 


从 机 器 人 系统 引入 了 力 反馈 。 主 从 机 器 人 分 别 作为 传 
感 器 和 显示 设备 建立 用 户 和 任务 环境 之 间 的 前 馈 和 反 
馈 通 道 。 图 31. 13 所 示 为 常见 的 用 户 与 任务 环境 之 间 
的 控制 链 ， 由 许多 部 件 构 成 。 


&T -| [ha 


操作 者 ” 主 操 作 器 Erma 


通信 


从 控制 器 远程 机 器 人 环境 


图 31. 13 典型 的 双向 区 操作 机 器 人 可 被 视 为 用 户 到 任务 环境 的 一 个 控制 链 


双向 控制 的 特点 使 得 控制 结构 过 到 挑战 ， 多 反馈 
回路 形式 以 及 主 从 机 器 人 在 没有 任务 环境 接触 或 用 户 
接 入 时 形成 一 个 内 部 闭环 回路 。 站 点 间 的 通信 给 系统 
和 回路 带 来 了 时 延 ， 从 而 给 系统 稳定 性 带 来 
挑战 。 

为 了 在 不 出 现 稳定 性 问题 的 前 提 下 提供 力 信息 ， 
需要 借助 摄像 头 或 可 触摸 设备 ”” 。 此 外 ,结合 
精确 的 力 反馈 信息 的 触感 式 方法 可 以 提高 系统 的 高 频 
性 能 ， 且 给 用 户 带 来 更 好 的 体验 ”5 S flee (IURI 
显示 也 可 用 来 向 用 户 提供 受 力 信息 

以 下 将 对 精确 的 力 反馈 进行 讨论 。 在 讨 企稳 定性 
以 及 一 些 高 级 技术 之 前 首先 看 看 基本 的 控制 结构 。 


31.4.1 位 置 / 力 控 制 


主 从 机 器 人 的 基本 结构 为 : 位 置 一 位 置 ， 位 置 一 
力 。 假 设 机 器 人 的 顶层 相连 ，31.3.3 节 中 的 等 式 为 


g (31.52) 


平移 控制 规则 。 方 向 和 关节 运动 的 控制 也 具有 相应 的 
控制 规则 。 


1. 位 置 一 位 置 结构 
最 简单 的 情况 是 机 器 人 根据 指令 相互 追踪 。 两 站 


点 均 和 采用 了 跟踪 控制 器 ， 通 常 为 PD 控制 需 来 实现 以 
下 控制 

F,--K,(x,-x,4) Ba Xn Xna) 

F, = -K,(x,-x4)-B.(x,-x4) (31.7) 


如 果 位 置 和 速度 比例 常数 相同 (Ka = K, =K, 
B, -B, = 妃 ) ， 那 么 二 者 的 受 力 相同 且 系统 可 进行 有 
效力 反馈 。 也 可 解释 为 主 从 机 器 人 的 顶层 间 存 在 一 个 
弹簧 阻尼 装置 ， 如 图 31. 14 所 示 。 如 果 主 从 机 器 人 互 
不 相同 且 位 置 和 速度 比例 常数 也 不 同 ， 那 么 要 对 主 从 
机 器 人 的 受 力 进行 标 度 和 /或 变形 。 
注意 ， 我 们 假设 从 机 器 人 是 用 阻抗 控制 方式 且 能 
被 动 驱动 (back drivable) 。 若 从 机 器 人 采用 指令 控 


天 
ty poo 
[| 
B 


图 31. 14 位 置 一 位 置 控制 结构 采用 弹簧 
阻尼 器 控制 主 从 机 器 人 


制 ， 也 就 是 说 ， 它 能 直接 接受 位 置 控 人 
省 略 式 (31.7) 的 第 二 部 分 。 
用 户 通过 力 反馈 控制 器 获得 从 机 器 人 的 受 力 
信息 ， 其 中 包括 与 弹簧 阻尼 器 相关 的 受 力 以 及 从 
BL A BS ELTE JJ A BE Se 7], SE Ps Efe 5 ADL ds 
人 无 接触 的 情况 下 ， 用 户 需 要 惯性 以 及 其 他 动态 
受 力 信息 来 控制 从 机 器 人 的 运动 。 若 从 机 器 人 不 
能 被 动 驱动 ， 即 无 法 轻易 地 通过 环境 施 力 来 改变 
运动 ， 那么 环境 施 力 将 被 用 户 屏蔽 。 显 然 力 反 馈 
就 失去 了 意义 。 在 这 样 的 情况 下 ,本 地 的 力 控制 
系统 将 作为 从 机 器 人 的 被 动 驱动 。 相 应 地 ， 控 制 
结构 将 采用 位 置 一 力 结构 。 

2. 位 置 一 力 结构 

在 位 置 一 力 结构 中 ， 从 机 器 人 的 力 反馈 控制 器 向 
用 户 提供 从 机 器 人 的 受 力 信息 。 由 于 从 机 器 人 的 受 力 
很 稳定 ， 也 就 意味 着 用 户 感受 到 的 是 从 机 器 人 在 控制 
顺 驱 动 下 殉 服 的 摩擦 力 和 惯性 力 。 很 多 情况 下 我 们 不 
希望 出 现 这 样 的 情况 。 为 避免 这 个 问题 ， 位 置 一 力 结 
构 中 ， 在 从 机 器 人 的 顶层 安装 一 个 力 传 感 咒 反 馈 受 力 
信息 ， 也 就 是 系统 由 如 下 等 式 控制 


息 ， 
Fa SF genso F, -K(x, -Xa) 


制 指令 ， 那 么 可 


B(x, - X4) 
(31.8) 
x RAM acie Mq MUR 
力 ， 因 此 对 任务 环境 有 更 清楚 的 认识 。 然 而 ， 该 结构 
ee 
器 人 的 运动 ， 任 务 环 境 受 力 ， 最 后 回 到 主机 器 人 受 
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力 。 从 机 器 人 的 运动 跟踪 可 能 会 出 现 滞 后 ， 更 不 用 说 
回路 中 通信 延迟 。 回 路 增益 值 可 能 会 很 高 : 如 果 从 机 
器 人 正在 穿越 刚性 环境 时 ， 小 幅 运 动 控制 指令 可 能 

变 成 一 个 很 大 的 受 力 。 总 的 来 说 ， 在 有 刚性 接触 时 ， 
系统 的 稳定 性 可 能 会 折 中 ， 这 种 情况 下 很 多 系统 都 出 
现 了 通信 不 稳定 。 


31.4.2 被动 性 和 稳定 性 


31. 4. 1 节 中 介绍 的 两 种 基本 的 控制 结构 很 清楚 
地 指出 了 力 反馈 控制 需要 考虑 的 问题 : 系统 稳定 性 和 
控制 性 能 。 之 所 以 会 出 现 稳定 性 问题 是 因为 系统 的 任 
何 模型 都 是 依赖 于 任务 环境 和 用 户 建立 的 。 我 们 很 难 
捕捉 到 任务 环境 和 用 户 信息 ， 如 对 未 知 环境 进行 勘探 
无 法 进行 环境 信息 预测 。 这 增加 了 系统 稳定 性 分 析 
的 难度 。 被 动 性 概念 的 引入 可 以 避免 以 上 问题 。 尽 管 
被 动 性 仅仅 提出 了 系统 稳定 的 充分 (JER) 条 件 ， 
但 仍然 能 很 好 地 处 理 任务 环境 的 不 确定 性 。 

被 动 性 是 一 种 直观 的 工具 ， 通 过 系统 的 能 量 来 六 
断 系统 的 稳定 性 ， 如 果 能 量 耗 散 则 系统 稳定 ， 如 果 能 


rn 


= 


可 以 保证 系统 的 稳定 性 ， 而 不 需要 对 任务 环境 进行 精 
确 建 模 。 

在 主 站 点 中 由 于 操作 者 也 处 于 闭环 回路 中 ， 因 此 
作 稳 定性 分 析 时 必须 考虑 操作 者 。 通 常 主机 器 人 由 用 
户 的 手 和 和 手 辟 构成。 表征 操作 者 手臂 动态 特性 的 模型 
和 变量 有 很 多 ， 其 中 主要 是 阻尼 弹簧 系统 模型 。 参考 
文献 [31.53] 对 不 同 模 型 变量 进行 了 汇总 。 对 于 一 
个 阻抗 控制 的 可 触 接口 ， 对 大 多 数 系统 而 言 系统 稳定 
性 分 析 最 坏 的 情况 是 操作 者 脱离 了 可 触 设备 5。 
因此 我 们 在 进行 稳定 性 分 析 时 可 能 会 忽略 操作 者 
(Fuss =0)。 如 果 一 个 系统 稳定 ， 那 么 操作 者 与 设备 
交互 时 系统 仍然 稳定 。 

我 们 以 图 31.13 所 示 的 系统 为 例 分 析 被 动 性 的 应 
用 。 将 该 系统 表示 为 二 端口 部 件 构 成 的 控制 链 ， 如 图 
31.15 所 示 。 我 们 规定 当 电 流 方向 向 右 时 为 正 电 流 。 
如 在 第 一 个 环节 中 ， 正 向 电流 为 主机 器 人 的 速度 与 操 
作者 受 力 的 乘积 


mT human (31.9) 
在 最 后 一 个 环节 中 ， 正 向 电流 为 从 机 器 人 的 速度 与 环 


量 增加 则 系统 不 稳定 。 以 下 为 三 条 重要 规则 : OHH 
仅 当 系统 不 产生 能 量 时 系统 是 被 动 的 ， 也 就 是 系统 的 
输出 能 量 受 限于 系统 的 初始 和 积聚 的 能 量 ; @ 两 个 被 
动 系统 可 以 结合 为 一 个 新 的 被 动 系统 ; @@ 两 个 被 动 系 
统 具 有 稳定 的 反馈 连接 。 

在 遥 操 作 机 器 人 中 ， 我 们 通常 假设 从 机 融 人 只 后 
被 动 的 环境 交互 ， 也 就 是 任务 环境 中 没有 电动 机 等 驱 
动 絮 。 在 没有 操作 者 的 情况 下 ， 只 要 系统 是 被 动 的 就 


境 受 力 (与 操作 者 的 受 力 相反 ) 的 乘积 

Pas EF, (31.10) 
因此 遥 操 作 机 器 人 系统 如 果 满 足下 式 ， 则 为 被 动 
系统 


上 Pd - | Pa - Pri) dt 
= | (Pi EF nlt > 7 ELLQ) 
(31. 11) 


Æ 31.15 通 操 作 机 器 人 系统 被 表示 为 二 端口 部 件 构 成 的 控制 链 ， 建立 用 户 和 任务 环境 连接 


为 简化 分 析 ， 先 检验 每 个 端口 的 被 动 性 ， 然 后 推 
断 整 个 系统 的 被 动 性 。 由 于 主 从 机 器 人 为 机 械 部 件 ， 
因而 是 被 动 的 。 因 为 位 置 一 位 置 结构 的 控制 器 是 模仿 
弹 和 钼 和 阻尼 如 ， 所 以 也 是 被 动 的 。 那 么 ,我 们 可 以 推 
出 在 没有 时 延 的 情况 下 ,位置 一 位 置 结构 是 被 动 的 。 
由 于 被 动 型 具有 很 强 的 处 理 不 确定 性 的 能 力 ， 
此 可 能 会 过 于 保守 。 若 每 一 个 子 系统 都 是 被 动 的 ， 那 
么 控制 器 会 出 现 严 重 超 调 。 相 反 ， 将 主动 的 子 系统 和 
被 动 的 子 系统 结合 得 到 的 系统 认为 是 被 动 的 ， 且 系统 
稳定 能 量 耗 散 小 。 对 于 图 31. 15 所 示 的 二 端口 部 件 级 
联系 统 尤 为 如 此 。 网 络 理 论 中 的 Llewellyn 准则 指出 


一 个 主动 的 二 端口 子 系统 与 任何 被 动 的 一 端口 系统 相 
连 得 到 的 系统 仍 是 被 动 的 。 这 样 的 二 端口 系统 称 为 无 
条 件 稳定 系统 ， 与 任意 两 个 一 端口 被 动 子 系统 相连 后 
得 到 的 系统 仍 是 稳定 的 。Llewellyn 准则 可 被 用 作 遥 操 
作 机 器 人 系统 或 部 件 的 稳定 性 判别 标准 。 
由 于 被 动 控制 器 不 能 隐藏 从 机 器 人 的 动态 特性 ， 
因而 功能 受 限 。 在 上 文 介绍 的 位 置 一 位 置 结构 中 ， 用 
户 可 以 感知 与 从 机 器 人 惯性 相关 的 受 力 。 而 位 置 一 力 
结构 对 用 户 隐 藏 从 机 器 人 的 惯性 力 和 摩擦 力 信息 。 因 
此 ， 当 用 户 向 主机 器 人 注入 能 量 而 没 感觉 到 任何 反抗 
作用 时 ， 系 统 也 同时 给 从 机 器 人 提供 能 量 。 这 使 得 系 
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统 被 动 特性 受到 扰动 ， 且 进一步 解释 了 系统 为 什么 存 
在 稳定 性 问题 。 


31.4.3 ”透明度 和 多 通道 反馈 


由 Lawrence" 5 设计 的 通用 遥 操 作 控制 系统 包含 
以 上 两 种 基本 的 控制 结构 ，HashtrudiZaad 和 Salcud- 
ean 随后 对 该 方法 进行 了 扩展 ， 如 图 31. 16 所 示 。 
理想 情况 下 还 操作 者 操纵 主机 器 人 跟踪 从 机 器 人 的 运 
动 ， 同 时 使 得 操作 者 的 受 力 与 环境 力 匹 配 ， 测 量 主 从 
站 点 的 位 置 和 受 力 ， 这 样 ， 当 用 户 对 主机 器 人 施加 作 
用 力 时 ， 从 机 器 人 甚至 可 以 在 主机 器 人 运动 之 前 就 立 
即 开始 运动 。 


图 31. 16 控制 器 利用 主 从 机 器 人 的 
位 置 和 受 力 信息 


由 参考 文献 [31.13] 中 提出 的 概念 ， 可 以 通过 
阻抗 和 导 纳 的 形式 来 判断 速度 和 受 力 之 间 的 关系 。 假 
设 所 有 的 自由 度 都 可 以 单独 处 理 ， 我 们 首先 看 看 单 自 
由 度 的 情况 。 环 境 的 阻抗 Z.(s) 为 未 知 量 ， 且 将 环 
境 力 与 从 机 器 人 的 速度 建立 如 下 联系 

F.(s) 2Z,(s)v,Cs) (31. 12) 

如 果 将 遥 操 作者 视 为 一 个 二 端口 系统 ， 可 由 以 下 

矩阵 方程 定义 


po nel v (s) ) 
va (s) B Ha (s) Hy Cs) A -F,(s) 


(31.13) 


用 户 感知 到 的 阻抗 为 
z.G) EO = CH, nz Un, - Hoz)" 
to v. (s) 11 12“e 21 22“e 


(31.14) 

透明 度 描述 了 用 户 感 知 的 阻抗 与 真实 环境 阻抗 的 

接近 程度 。 

对 于 遥 操 作 机 器 人 被 动 性 的 具体 实现 ， 以 及 阻 

抗 和 导 纳 的 说 明 , 设计 和 透明 度 参 见 参 考 文献 
[31. 11-13, 56-59], 


31.4.4 ”时 延 和 散射 理论 


当 本 地 站 点 和 远程 站 点 存在 通信 时 延 时 ， 连 位 置 
一 位 置 结构 都 会 受到 很 严重 的 不 稳定 性 干扰 |。 
如 图 31. 15 所 示 的 通信 阻塞 ， 电 流 左 进 右 出 ， 却 没有 
进行 琶 加 。 阻 塞 不 但 不 能 产生 能 量 ， 反 倒 增加 了 系统 
RETES, 

参考 文献 [31.62] 研究 了 有 时 延 时 的 操作 方 
法 ， 特 别 是 共享 兼容 控制 ，* $1 和 增加 局 部 力 反馈 回 
BCE | Internet 作为 通信 工具 的 使 用 ， 增 加 了 时 延 
的 种 类 ， 也 是 研究 热点 5 “1 。 随 后 研究 了 数据 压 
缩 问题 1。 

由 于 自然 波动 现象 具有 双向 被 动 特性 ， 因 而 可 以 
AINE, WRU OH Hil AS ABA A TAE 
Eg NT AB RAH, RAET AAAI ET). WE 
射 和 矩阵 将 速度 和 受 力 与 二 者 的 差分 建立 联系 ， 因 此 被 
动 性 作为 系统 增益 的 条 件 不 受 时 延 影响 。 相 应 地 ， 可 
以 通过 精确 观察 被 动 性 来 保证 系统 的 稳定 性 ”1 。 


31.4.5 波动 变量 

波动 现象 规避 了 通信 时 延 存在 的 问题 ， 它 提供 了 
可 忍受 时 延 的 编码 方案 "”。 考 虑 系统 能 量 的 流动 ， 
将 正 向 电流 和 逆向 电流 分 开 。 

P=2P= Tu 50° = NES A 


(31.15) 
正 向 和 逆向 电流 必须 为 非 负 的 ， 因 而 有 如 下 波动 


变量 定义 : 
_b+F | bi-F (31.16) 
J2b J2b 
AP, u 为 正 向 波动 ; ”为 逆向 波动 。 
如 果 将 正常 信号 编码 为 波动 变量 ， 在 有 时 延 时 传 


送 ， 然 后 分 解 为 一 般 变量 ， 那 么 无 论 在 有 无 时 延 的 情 
况 下 ， 系 统 仍 为 被 动 的 。 实 际 上 ， 在 波动 领域 ， 被 动 
性 相当 于 波动 增益 。 由 于 对 相位 没有 任何 要 求 ， 因 此 
时 延 不 会 影响 系统 稳定 性 。 
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波动 阻抗 将 速度 与 力 连接 起 来 ， 且 向 用 户 提供 31.5 — RC en F. ae A aa po- 
LA ante p "ES Tm M sitional servomechanism, Nucleonics 10(11), 43-45 
TARNE, b 值 很 大 ， 则 意味 着 系统 以 增加 情 fees) 
性 力 来 增加 力 反馈 ; b 值 很 小 ， 则 降低 了 不 适 感 ， 使 31.6 W.R. Ferell: Remote manipulation with transmis- 
得 移动 更 为 容易 ， 但 同时 也 减 小 了 期 望 的 环境 受 力 。 sion dE Trans. Hum. Factors Electron. 6, 
" 24-32 (1965 
FEY 3 ME U^ pp his AJ t 
理想 情况 下 ， 在 没有 连接 风险 时 操作 者 会 减 小 6 的 31.7  T.B. Sheridan, W.R. Ferell: Remote manipulative 
值 ， 当 需要 进行 连接 的 时 候 则 增加 4 的 值 。 control with transmission delay, IEEE Trans. Hum. 
"T" GrH S SR EMI E bot Factors Electron. &, 25-29 (1963) 
近期 有 研究 iss 位 EAE S fi pde 31.8  F. Miyazaki, S. Matsubayashi, T. Yoshimi, S. Ari- 
合 到 波动 框架 中 ， 所 得 的 系统 对 于 任何 环境 、 任 何 时 moto: A new control methodology towards 
延 都 是 稳定 的 ， 保持 了 高 频 力 反馈 ， 以 帮助 操作 者 advanced teleoperation of master-slave robot sys- 
fl EN k ee A 、 a is tems, Proc. IEEE Int. Conf. Robot. Autom., Vol.3 
识别 远程 站 点 发 生 的 情况 。 为 了 改进 系统 的 性 (1986) pp. 997-1002 
能 及 辅助 操作 者 ， 也 可 以 引入 预测 器 号 7 。 31.9 RJ. Anderson, M.W. Spong: Asymptotic stability for 
force reflecting teleoperators with time delay, Int. 
8 y 
J. Robot. Res. 11(2), 135-149 (1992) 
31. 5 结论 31.10 G. Niemeyer, J.-J.E. Slotine: Stable adaptive tele- 
operation, IEEE J. Oceanogr. Eng. 16(1), 152-162 
" (1991) 
遥 操 作 机 咒 人 仍然 是 机 器 人 领域 的 一 个 令 人 兴奋 31.11 J.E. Colgate: Robust impedance shaping telema- 
日 充满 活力 的 研究 领域 。 它 提供 了 一 个 综合 利用 高 级 人 Robot. Autom. 9(4), 374-384 
SAE Pah Meee RAB GE s chemin . 
机 器 人 技术 和 用 户 操作 技术 能 力 的 平台 ， 就 如 同 汽车 31.12 B. Hannaford: A design framework for teleopera- 
技术 的 发 展 与 驾驶 人 的 关系 。 由 于 增加 了 电子 稳定 性 tors with kinesthetic feedback, IEEE Trans. Robot. 
控制 系统 和 导航 系统 ， 汽 车 结构 变 得 越 来 越 复杂 ， 也 ee -- 
rop 、 e osi m 31.13 D.A. Lawrence: Stability and transparency in bilat- 
更 安全 实用 ,但 无 论 怎 样 都 无 法 取代 驾驶 人 。 同 样 ， eral teleoperation, IEEE Trans. Robot. Autom. 9(5), 
各 操作 机 器 人 作为 一 项 不 断 完 善 的 技术 ， 最 吻合 人 类 。 G2 037 PERRO 
NETEN : . NO $ . Kuban, H.L. Martin: An advanced remotely 
+H] BS a HI M xb Sie ; 
Isto studi A EEST IRAGA, ERED Laie A maintainable servomanipulator concept, Proc. 
已 被 用 于 搜救 领域 。 近 期 遥 操 作 外 科 手 术 系 统 的 发 展 1984 Natl. Top. Meet. Robot. Remote Handl. Hostile 
"S 、 3 Environ. (American Nuclear Society, Washington 
和 商业 化 ， 给 数 以 万 计 的 病人 带 来 福音 ， 且 将 机 器 人 l 8 
的 研究 领域 拓展 到 人 类 世界 。 31.15 J. Vertut, P. Coiffet: Teleoperation and Robotics: 
监督 控制 的 进一步 研究 参见 参考 文献 [31.35], Evolution and Development, Robot Technol., 
m E a fert Vol. 3A (Hermes, Oslo 1985) 
尽管 该 文 发 表 于 1992 年 ， 但 它 对 该 领域 的 讨论 仍 最 为 31.16 J. Vertut: MA23M contained servo manipulator 
完整 。 遗 憾 的 是 ， 只 有 少数 几 本 书 对 遥 操 作 机 器 人 领 with in Www dien Ue pn UR 
uS ic pe É " supports, with computer-integrated control, Proc. 
Dy Has F Be EL y 
域 作 了 完整 的 讨论 。 参 考 文献 [31.75] 收集 了 最 新 28th Remote Syst. Technol. Conf., Vol.2 (1980) 
的 控制 方法 、 时 延 、 应 用 和 发 展 等 研究 成 果 。 除 此 之 pp.13-19 
m Pr TL 31.17 J. Vertut, P. Coiffet: Bilateral servo manipulator 
ESSE] dExrd 1 n u ^ j 
^h, SIL lee oS E A Ela A MA23 in direct mode and via optimized computer 
作 进 一 步 了 解 ， 请 参阅 相关 文献 。 除 了 机 器 人 期 刊 外 ， control, Proc. 2nd RMS Conf., Vol. 12 (1977) 
我 们 还 特别 推荐 麻 省 理工 学 院 出 版 社 出 版 的 Presence : 31.18 A.K. Bejczy: Towards advanced teleoperation 
. . DEUS Ls in space. In: Teleoperation and Robotics in 
Teleoperators and Virtual Environments。 该 杂志 结合 虚拟 Space, Prog. Astronaut. Aeronaut., Vol.161, ed. by 
现实 的 应 用 ， 并 重点 关注 操作 者 的 操作 技术 。 S.B. Skaar, C.F. Ruoff (American Institue of Aero- 
nautics and Astronautics, Reston 1994) pp.107-138 
i 31.19 T.H. Massie, J.K. Salisbury: The phantom haptic in- 
参 考 X. B terface: A device for probing virtual objects, Proc. 
ASME Int. Mech. Eng. Congr. Exhib. (Chicago 1994) 
31.1 M. Buss, G. Schmidt: Control problems in multi- 31.20 a B. Brunner, J. Dietrich, J. Heindl: 
modal telepresence systems, Adv. Control, High- Sensor-based space robotics — ROTEX and its teler- 
lights Eur. Control Conf. (ECC'99) (1999) pp. 65-101 obotic features, IEEE Trans. Robot. Autom. 9(5) 
31.2 W.R. Ferell, T.B. Sheridan: Supervisory control of 649-663 (1993) j 
remote manipulation, IEEE Spectrum 4(10), 81-88 ; : ; 
(1967) í Ü 31.21 J.Marescaux, J. Leroy, F. Rubino, M. Vix, M. Simone, 
D. Mutter: Transcontinental robot assisted remote 
31:3 iir duda a telesurgery: Feasibility and potential applications, 
31.4 RC Quer e e maste —slave mani ulato Ann. Surg. 235, 487-492 (2002) 
i m : r P h 31.22 G.H. Ballantyne: Robotic surgery, telerobotic 


Nucleonics 12(11), 45-46 (1954) 


第 31 章 


遥 操 作 机 器 人 


249 


31.23 


31.24 


31.25 


31.26 


31.27 


31.28 


31.29 


31.30 


31.31 


31.32 


31.33 


31.34 


31.35 


31.36 


31.37 


surgery, telepresence, and telementoring - Re- 
view of early clinical results, Surg. Endosc. 16(10), 
1389-1402 (2002) 

G.S. Guthart, J.K. Salisbury: The Intuitive™ 
telesurgery system: Overview and application, 
Proc. IEEE Int. Conf. Robot. Autom. (San Francisco 
2000) pp. 618-621 

J.M. Sackier, Y. Wang: Robotically assisted la- 
paroscopic surgery: From concept to development. 
In: Computer-Integrated Surgery: Technology and 
Clinical Applications, ed. by R.H. Taylor, S. Laval- 
lée, G.C. Burdea, R. Mósges (MIT Press, Cambridge 
1996) pp. 577-580, Chap. 45 

D.H. Birkett: Electromechanical instruments for 
endoscopic surgery, Minimally Invasive Therapy 
and Allied Technologies 10(6), 271-274 (2001) 

J. Rosen, B. Hannaford: Doc at a distance, IEEE 
Spectrum 8(10), 34-39 (2006) 

A.M. Okamura: Methods for haptic feedback 
in teleoperated robot-assisted surgery, Industr. 
Robot 31(6), 499-508 (2004) 

T. Ortmaier, B. Deml, B. Kübler, G. Passig, 
D. Reintsema, U. Seibold: Robot assisted force 
feedback surgery. In: Advances in Telerobotics, 
Springer Tracts Adv. Robot., Vol. 31, ed. by M. Ferre, 
M. Buss, R. Aracil, C. Melchiorri, C. Balaguer 
(Springer, Berlin, Heidelberg 2007) pp.361-79, 
Chap. 21 

B.M. Yamauchi: PackBot: A versatile platform for 
military robotics, Proc. SPIE 5422, 228-237 (2004) 
R.R. Murphy: Trial by fire [rescue robots], IEEE 
Robot. Autom. Mag. 11(3), 50-61 (2004) 

J. Wright, A. Trebi-Ollennu, F. Hartman, B. Cooper, 
S. Maxwell, J. Yen, J. Morrison: Driving a Rover 
on Mars Using the Rover Sequencing and Visu- 
alization Program, International Conference on 
Instrumentation, Control and Information Tech- 
nology (Okayama University, Okayama 2005) 

G. Hirzinger, K. Landzettel, D. Reintsema, 
C. Preusche, A. Albu-Scháffer, B. Rebele, M. Turk: 
ROKVISS — Robotics component verification on ISS, 
Proc. 8th Int. Symp. Artif. Intell. Robot. Autom. 
Space (iSAIRAS) (Munich 2005) p. Session2B 

C. Preusche, D. Reintsema, K.  Landzettel, 
G. Hirzinger: ROKVISS - Preliminary results for 
telepresence mode, Proc. IEEE/RSJ Int. Conf. 
Intell. Robot. Syst. (IROS) (Peking 2006) pp.4595- 
4601 

G. Hirzinger, K. Landzettel, B. Brunner, M. Fi- 
scher, C. Preusche, D. Reintsema, A. Albu-Scháffer, 
G. Schreiber, M. Steinmetz: DLR's robotics tech- 
nologies for on-orbit servicing, Adv. Robot. - 
Special Issue Service Robots in Space 18(2), 139-174 
(2004) 

T.B. Sheridan: Telerobotics, Automation and Hu- 
man Supervisory Control (MIT Press, Cambridge 
1992) 

G. Hirzinger, J. Heindl, K. Landzettel, B. Brunner: 
Multisensory shared autonomy - a key issue in the 
space robot technology experiment ROTEX, Proc. 
RSJ/IEEE Int. Conf. Intell. Robot. Syst. (1992) 

A.K. Bejczy, W.S. Kim: Predictive displays and 
shared compliance control for time-delayed tele- 
manipulation, IEEE Int. Workshop Intell. Robot. 


31.38 


31.39 


31.40 


31.41 


31.42 


31.43 


31.44 


31.45 


31.46 


31.47 


31.48 


31.49 


31.50 


31.51 


31.52 


31.53 


31.54 


Syst. (Ibaraki 1990) pp. 407-412 

P. Backes, K. Tso: UMI: An interactive supervi- 
sory and shared control system for telerobotics, 
Proc. IEEE Int. Conf. Robot. Autom., Cincinatti (1990) 
pp. 1096-1101 

L. Conway, R. Volz, M. Walker: Tele-autonomous 
systems: Methods and architectures for inter- 
mingling autonomous and telerobotic technology, 
Proc. IEEE Int. Conf. Robot. Autom., Vol.2 (Raleigh 
1987) pp. 1121-1130 

S. Hayati, S.T. Venkataraman: Design and imple- 
mentation of a robot control system with traded 
and shared control capability, Proc. IEEE Int. Conf. 
Robot. Autom., Vol.3 (Scottsdale 1989) pp.1310- 
1315 

G. Hirzinger, B. Brunner, J. Dietrich, J. Heindl: RO- 
TEX - The first remotely controlled robot in space, 
Proc. IEEE Int. Conf. Robot. Autom., Vol.3 (San 
Diego 1994) pp. 2604-2611 

B. Brunner, K. Arbter, G. Hirzinger: Task directed 
programming of sensor based robots, Proc. IEEE/RSJ 
Int. Conf. Intell. Robot. Syst., Vol. 2 (Munich 1994) 
pp. 1080-1087 

T. Ortmaier, M. GrOger, D.H. Boehm, V. Falk, 
G. Hirzinger: Motion estimation in beating heart 
surgery, IEEE Transactions on Biomedical Engineer- 
ing (TBME) 52(10), 1729-1740 (2005) 

L. Rosenberg: Virtual fixtures: Perceptual tools for 
telerobotic manipulation, Proc. IEEE Virtual Real. 
Int. Symp., New York (Seattle 1993) pp. 76-82 

J.J. Abbott, P. Marayong, A.M. Okamura: Hapticvir- 
tual fixtures for robot-assisted manipulation, Proc. 
12th Int. Symp. Robot. Res., Vol. 28 (2007) pp. 49-64 
M.J. Massimino, T.B. Sheridan, J.B. Roseborough: 
One handed tracking in six degrees of freedom, 
Proc. IEEE Int. Conf. Syst. Man Cybern., Vol.2 (Cam- 
bridge 1989) pp. 498-503 

A. Casals, L. Munoz, J. Amat: Workspace defor- 
mation based teleoperation for the increase of 
movement precision, Proc. IEEE Int. Conf. Robot. 
Autom. (Taipei 2003) pp. 2824-2829 

F. Conti, 0. Khatib: Spanning large workspaces 
using small haptic devices, Proc. 1st Joint Eurohap- 
tics Conf. Symp. Haptic Interfaces Virtual Environ. 
Teleoper. Syst. (Pisa 2005) pp. 183-188 

R.W. Daniel, P.R. McAree: Fundamental limits of 
performance for force reflecting teleoperation, Int. 
J. Robot. Res. 17(8), 811-830 (1998) 

M.J. Massimino, T.B. Sheridan: Sensory substitu- 
tion for force feedback in teleoperation, Presence 
Teleoper. Virtual Environ. 2(4), 344—352 (1993) 

D.A. Kontarinis, R.D. Howe: Tactile display of vi- 
bratory information in teleoperation and virtual 
environments, Presence Teleoper. Virtual Environ. 
4(4), 387-402 (1995) 

D.A. Kontarinis, J.S. Son, W.J. Peine, R.D. Howe: 
A tactile shape sensing and display system for tele- 
operated manipulation, Proc. IEEE Int. Conf. Robot. 
Autom. (Nagoya 1995) pp. 641-646 

JJ. Gil, A. Avello, A. Rubio, J. Flórez: Stability 
analysis of a 1 DOF haptic interface using the 
Routh-Hurwitz criterion, IEEE Trans. Control Syst. 
Technol. 12(4) 583-588 (2004) 

N. Hogan: Controlling impedance at the man/ ma- 


2S0 


第 4 篇 


操作 与 接口 


31.55 


31.56 


31.57 


31.58 


31.59 


31.60 


31.61 


31.62 


31.63 


31.64 


chine interface, Proc. IEEE Int. Conf. Robot. Autom. 
(Scottsdale 1989) pp. 1626-1631 

R.J. Adams, B. Hannaford: Stable haptic interac- 
tion with virtual environments, IEEE Trans. Robot. 
Autom. 15(3), 465-474 (1999) 

K. Hashtrudi-Zaad, S.E. Salcudean: Analysis of con- 
trol architectures for teleoperation systems with 
impedance/admittance master and slave manip- 
ulators, Int. J. Robot. Res. 20(6), 419—445 (2001) 

Y. Yokokohji, T. Yoshikawa: Bilateral control of 
master-slave manipulators for ideal kinesthetic 
coupling =- formulation and experiment, IEEE 
Trans. Robot. Autom. 10(5), 605—620 (1994) 

K.B. Fite, J.E. Speich, M. Goldfarb: Transparency 
and stability robustness in two-channel bilateral 
telemanipulation, ASME J. Dyn. Syst. Meas. Control 
123(3), 400—407 (2001) 

S.E. Salcudean, M. Zhu, W.-H. Zhu, K. Hashtrudi- 
Zaad: Transparent bilateral teleoperation under 
position and rate control, Int. J. Robot. Res. 19(12), 
1185-1202 (2000) 

W.R. Ferrell: Remote manipulation with transmis- 
sion delay, IEEE Trans. Hum. Factors Electron. 6, 
24-32 (1965) 

T.B. Sheridan: Space teleoperation through time 
delay: Review and prognosis, IEEE Trans. Robot. 
Autom. 9(5), 592-606 (1993) 

A. Eusebi, C. Melchiorri: Force reflecting telema- 
nipulators with time-delay: Stability analysis and 
control design, IEEE Trans. Robot. Autom. 14(4), 
635-640 (1998) 

W.S. Kim, B. Hannaford, A.K. Bejczy: Force- 
reflection and shared compliant control in operat- 
ing telemanipulators with time delays, IEEE Trans. 
Robot. Autom. 8(2), 176-185 (1992) 

K. Hashtrudi-Zaad, S.E. Salcudean: Transparency in 
time-delayed systems and the effect of local force 
feedback for transparent teleoperation, IEEE Trans. 
Robot. Autom. 18(1), 108-114 (2002) 


31.65 


31.66 


31.67 


31.68 


31.69 


31.70 


31.71 


31.72 


31.73 


31.74 


31.75 


R. Oboe, P. Fiorini: A design and control environ- 
ment for internet-based telerobotics, Int. J. Robot. 
Res. 17(4), 433-449 (1998) 

S. Munir, W.J. Book: Control techniques and pro- 
gramming issues for time delayed internet based 
teleoperation, J. Dyn. Syst. Meas. Control 125(2), 
205-214 (2003) 

S. Hirche, M. Buss: Transparent data reduction in 
networked telepresence and teleaction systems. 
Part Il: Time-delayed communication, Presence 
Teleoper. Virtual Environ. 16(5), 532-542 (2007) 

S. Stramigioli, A. van der Schaft, B. Maschke, 
C. Melchiorri: Geometric scattering in robotic tele- 
manipulation, IEEE Trans. Robot. Autom. 18(4), 
588—596 (2002) 

B. Hannaford, J.H. Ryu: Time domain passivity con- 
trol of haptic interfaces, IEEE Trans. Robot. Autom. 
18(1), 1-10 (2002) 

J.-H. Ryu, C. Preusche, B. Hannaford, G. Hirzinger: 
Time domain passivity control with reference en- 
ergy following, IEEE Trans. Control Syst. Technol. 
13(5), 737-742 (2005) 

J. Artigas, C. Preusche, G. Hirzinger: Time domain 
passivity-based telepresence with time delay, 
Proc. IEEE/RSJ Int. Conf. Intell. Robot. Syst. (IROS), 
Peking (Peking 2006) pp. 4205-4210 

G. Niemeyer, J.-J.E. Slotine: Telemanipulation with 
time delays, Int. J. Robot. Res. 23(9), 873-890 
(2004) 

N.A. Tanner, G. Niemeyer: High-frequency accel- 
eration feedback in wave variable telerobotics, 
IEEE/ASME Trans. Mechatron. 11(2), 119-127 (2006) 

S. Munir, W.J. Book: Internet-based teleoperation 
using wave variables with prediction, IEEE/ASME 
Trans. Mechatron. 7(2), 124—133 (2002) 

M. Ferre, M. Buss, R. Aracil, C. Melchiorri, C. Balague 
(Eds.): Advances in Telerobotics, Springer Tracts 
Adv. Robot. (Springer, Berlin, Heidelberg 2007) 


第 32 章 WAEREA A 


Dezhen Song, Ken Goldberg, Nak Young Chong 
PAPE 译 


遥 操 作 机 器 人 ， 即 远程 控制 机 器 人 ， 被 广泛 应 
于 深海 和 外 层 空间 探测 、 炸 弹 排除 、 清 理 危 险 废 
料 等 工作 。 在 1994 年 以 前 ， 遥 操作 机 器 人 只 能 由 
经 过 训练 的 、 可 靠 的 专家 ， 通 过 专用 的 通信 信道 来 
使 用 。 本 章 描 述 了 基于 网 络 的 遥 操 作 机 器 人 ， 这 是 
一 种 新 型 的 遥 操 作 机 器 人 ， 可 以 通过 Internet 这 样 
的 网 络 来 控制 ， 并 面向 公众 开放 。 本 章 将 介绍 相关 
的 网 络 技术 ， 网 络 遥 操作 机 器 人 在 遥 操 作 和 领域 内 的 
历史 ， 网 络 遥 操作 机 器 人 的 属性 ， 如 何 构建 一 个 网 
络 遥 操作 机 器 人 ， 一 些 典 型 系统 ， 以 及 未 来 研究 的 
一 些 要 点 。 


32.1 HRS peer 251 
32.1 综述 与 背景 


如 图 32. 1 所 示 ,， 在 遥 操 作 领 域 中 ， 最 主要 的 关 
注 点 是 稳定 性 和 时 延 ， 这 些 在 第 31 章 中 已 经 有 了 介 
绍 。 而 网 络 机 器 人 ， 即 通过 本 地 网 络 通信 的 自主 机 器 
人 及 传感器 的 问题 ， 将 在 第 41 章 中 介绍 。 本 章 的 主 
题 是 网 络 遥 操作 机 器 人 ， 将 集中 讨论 由 公众 通过 网 络 
浏览 器 使 用 的 遥 操 作 机 器 人 系统 。 


a 
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图 32.1 网 络 怕 操作 机 器 人 (第 32 章 ) . ERE 
(第 31 章 ) 和 网 络 机 器 人 (第 41 章 ) 之 间 的 关系 


到 2006 年 ， 数 百 种 网 络 机 器 人 被 开发 并 投入 
面向 公众 的 在 线 使 用 。 有 许多 出 版 的 论文 描述 了 
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这 些 系统 ， 另 外 还 有 一 本 Goldberg 和 Siegwart 所 著 
的 关于 该 课题 的 专著 ”*' 1 。 关 于 最 新 研究 进展 的 
描述 和 总 结 可 以 在 IEEE 网 络 机 器 人 技术 委员 会 的 
网 站 上 获得 ， 该 委员 会 支援 和 发 展 了 网 络 机 器 人 
和 网 络 遥 操作 机 器 人 两 方面 的 研究 (IEEE 网 络 机 
器 人 技术 委员 会 http: //tab. ieee-ras. org/) o 

网 络 遥 操作 机 器 人 具有 如 下 属性 : 

1) 物理 世界 是 由 通过 本 地 的 网 络 服务 器 控制 的 
设备 影响 的 ， 用 户 通过 诸如 了 正 、 火 狐 这 样 的 网 络 浏 
览 器 与 网 络 服务 器 通信 ， 这 些 网 络 浏览 器 就 相当 于 通 
常 意义 上 的 客户 端 。 截 止 到 2006 年 ， 网 络 浏览 器 使 
用 的 标准 协议 是 超 文本 传输 协议 (HTTP) ， 这 是 一 种 
国际 性 的 传输 协议 。 

2) 大 多 数 的 网 络 遥 操作 机 器 人 都 是 一 直 在 线 可 
用 的 ， 维 持 一 天 24 小 时 ， 一 周 7 天 的 工作 时 间 。 

3) 由 于 现在 已 经 有 数 以 亿 计 的 用 户 使 用 着 In- 
ternet， 需 要 一 种 机 制 来 解决 客户 的 鉴别 和 分 类 
问题 。 

4) 网 络 遥 操作 机 器 人 的 输入 输出 设备 通常 是 标 
准 的 鼠标 、 键 盘 和 电脑 屏幕 。 

5) 客户 可 能 是 无 经 验 的 甚至 是 恶意 的 ， 在 线 导 
航 和 安全 保障 机 制 是 必要 的 。 
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dreessen 带领 的 一 组 学 生 开 发 了 开源 版 本 的 Mosaic 浏 
32.2 简要 回顾 览 器 ， 它 是 世界 上 第 一 个 图 形 界 面 的 网 络 浏览 器 ， 于 


就 像 其 他 的 技术 ， 远 程控 制 设 备 最 初 是 科幻 小 说 
的 一 种 设想 。1898 4E, Nicola Tesla' "1 演示 了 通过 无 
线 电 远程 控制 纽约 麦迪 逊 广场 花园 里 的 小 船 。 遥 操作 
领域 最 初 的 重要 实验 是 在 20 世纪 40 年 代 进 行 的 ， 动 
机 是 需要 处 理 放射 性 材料 。 到 了 20 世纪 50 年 代 ， 阿 
尔 贡 国家 实验 室 的 Goertz 展示 了 最 早 的 双边 模拟 器 之 
一 [> 。 远 程 操作 机 制 的 设计 是 为 了 完成 深海 和 
宇宙 空间 后 5 探测 这 样 在 人 类 难以 到 达 的 环境 中 进行 
的 工作 。 通 用 电气 公司 的 Mosher ^ 开发 了 一 个 双 臂 
T P MR Sk I E RME R Eo E PR AE t W H B 
EEUU, 最近， 遥 操 作 也 被 考虑 用 到 医疗 诊断 >、 
file? 和 精密 操作 '*'" 这 样 的 行业 中 。 更 多 关 
于 遥 操 作 和 遥 操 作 机 器 人 学 研究 的 精彩 陈述 参见 第 
31 SEI Sheridan?! 的 著作 。 

超 文本 (参考 链接 ) 的 概念 是 由 Vannevar Bush 
在 1945 年 提出 的 。 随 着 计算 机 和 网 络 科 学 的 发 展 ， 
超 文本 的 实现 成 为 可 能 。20 世纪 90 年 代 早 期 ，Bern- 
ers- Lee 提出 了 超 文 本 传输 协议 (HTTP) 。 由 Marc An- 


p 


1993 年 发 布 使 用 。 第 一 个 网 络 化 的 摄像 头 ， 即 网 络 
摄像 头 ， 在 1993 年 11 AACE 。 

大 约 9 个 月 以 后 ， 第 一 个 网 络 遥 操作 机 器 人 投入 
了 在 线 使 用 。K. Goldburg 和 M. Mascha 的 水 星 计划 将 
— IBM 的 工业 机 器 人 臂 和 数字 摄像 头 组 合 起 来 ， 
机 器 人 带 有 一 个 空气 喷嘴 ， 远 程 用户 能 够 用 这 些 装置 
在 一 个 沙 箱 中 挖掘 被 掩埋 的 人 工 物 体 *”…*。 西 澳 
大 利 亚 大 学 的 天 Taylor 和 J. Trevelyan 领导 着 男 一 支 
独立 工作 的 研究 团队 ，1994 年 11 月 他 们 展示 了 一 个 
可 以 被 远程 操控 的 六 轴 遥 操作 机 器 人 “中 yx ue 
早期 项 目 开 创 了 网 络 遥 操作 机 器 人 这 个 新 的 研究 领 
域 。 参 考 文献 [32.17-25] 是 一 些 其 他 的 例子 。 在 
http: //ford. ieor. berkeley. edu/ir/ 可 以 在 线 地 查 到 网 
络 遥 操作 机 器 人 的 最 新 研究 进展 。 

Sheridan 和 他 的 同事 提出 ': 守 2 ， 网 络 遥 操作 机 器 
人 是 监督 控制 遥 操 作 机 器 人 的 一 种 特例 。 在 监督 控制 
中 ， 一 个 本 地 计算 机 在 闭环 反馈 回路 中 起 着 重要 的 作 
用 。 大 多 数 的 遥 操 作 网 络 机 器 人 学 都 属于 第 e 型 监督 
控制 系统 〈 见 图 32.2) 。 


m) 


操 
1 i 1 
1 Y 1 
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操作 者 


直接 控制 


全 自动 控制 


监督 控制 


图 32.2 从 Sheridan 的 著作 1] 中 摘出 的 一 系列 遥 操 作 控制 模式 。 我 们 按照 机 器 人 自主 性 强 弱 排序 ， 依 次 标记 为 


a) ~e) 。 


人 类 完全 被 限制 为 观察 和 监测 的 角色 。 


最 左边 是 机 械 式 的 连接 ， 人 类 在 另 一 个 房间 ， 通 过 滑动 机 械 接触 杆 直接 操作 机 器 人 ; 最 右边 的 系统 中 
c) ~e) H, 虚线 显示 了 通信 可 能 出 现 不 畅 
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尽管 大 多 数 网 络 遥 操作 机 器 人 系统 只 包含 一 个 人 
类 操作 者 和 一 个 机 器 人 屏 2%31 Chong 等 人 提出 了 一 
种 有 用 的 分 类 方式 : 单 操作 者 单机 器 人 系统 (SOSR ) ， 
单 操作 者 多 机 器 人 系统 (SOMR) ， 多 操作 者 单机 器 人 
系统 (MOSR) ， 多 操作 者 多 机 器 人 系统 (MOMR ) 。 

1995 年 ~2005 FEKI FEW, PEER VE DL OSA 
有 了 非常 广阔 的 发 展 。 新 的 系统 ， 新 的 实验 ， 新 的 应 
用 ， 已 经 不 限于 如 国防 、 字 宙 空 间 开 发 、 核 废料 处 
Jg 1 51k 20 世纪 50 年 代 推 动 网 络 遥 操作 机 器 人 
研究 发 展 的 传统 应 用 领域 。 随 着 Internet 把 人 们 生活 
的 方方面面 连接 到 一 起 ， 网 络 机 器 人 对 现代 社会 的 影 


一 个 地 方 的 媒介 。 链 接 的 实例 包括 铜 质 或 光纤 的 电线 
和 无 线 (射频 或 红外 ) 信道 。 交 换 机 和 路 由 器 是 引 
导 链 接 之 间 数 字 信息 交换 的 设备 。 主 机 是 通信 终端 节 
点 ， 如 浏览 器 、 计 算 机 和 机 器 人 。 

网 络 可 以 是 集中 在 某 一 片 物理 区 域 (局 域 网 ， 
LAN) 内 的 , 或 者 是 分 布 在 长 距离 范围 上 的 ( 广 域 
网 ，WAN)。 连 接 控制 是 网 络 设计 中 的 基础 问题 。 在 
大 量 方法 中 ， 以 太 网 协议 是 使 用 最 为 广泛 的 。 以 太 网 
提供 了 一 个 具有 广播 能 力 的 多 连接 局 域 网 。 它 采用 了 
载波 监听 多 路 访问 (CSMA) 策略 来 解决 连接 问题 。 
TE IEEE 802. x 标准 的 定义 中 ，CSMA 允许 每 个 主机 在 


响 也 越 来 越 广 阔 和 深入 。 最 新 的 应 用 包括 了 教育 、 工 
业 、 商 业 、 健 康 护理 、 地 质 考 察 和 环境 监测 ， 涵 盖 了 
从 娱乐 到 艺术 的 各 方 各 面 。 
网 络 遥 操作 机 器 人 提供 给 人 们 一 种 新 的 和 远程 环 
境 交 互 的 媒介 。 与 普通 的 视频 会 议 系 统 相 比 ， 网 络 机 
器 人 能 提供 更 强 的 交互 特性 。 实 际 机 器 人 不 仅 代 表 了 
在 远 端 的 操作 者 ， 还 将 多 种 不 同 的 反馈 信息 传输 给 
他 ， 在 参考 文献 [32. 29] 中 这 种 特性 通常 被 称 为 遥 
TE, Paulos 和 Canny BJ ^S A XR UE ( personal roving 
presence, PRoP) HLASA'?*! , LAR Jouppi 和 Thomas 
的 代理 人 (surrogate) PLAGE AT?) ETE ETT S 
遥 在 研究 项 目 。 
网 络 遥 操作 机 器 人 在 教育 和 培训 上 有 着 极 大 的 淤 
力 。 事 实 上 ， 最 早 的 网 络 遥 操作 机 器 人 系统 之 
一 [中 就 是 由 远程 图 书馆 这 一 创意 而 来 。 网 络 遥 操 
作 机 器 人 能 面向 公众 开放 广泛 的 连接 入 口 ， 令 没有 或 
者 只 有 很 少 机 器 人 知识 的 大 众 能 够 有 机 会 了 解 、 学 习 
和 操作 机 器 人 ， 这 些 机 器 人 过 去 都 是 昂贵 的 科研 设 
备 ， 只 有 大 学 和 大 型 的 联合 实验 室 能 够 使 用 。 在 网 络 
遥 操 作 机 器 人 的 基础 上 , TER fe Sce uU 70 通 
过 提供 互动 经 验 的 方式 极 大 改善 了 远程 学 习 的 效果 。 
举例 来 说 ， 可 遥 操 作 的 远程 望远镜 能 帮助 学 生理 解 天 
Wok 70" 。 遥 操作 显微镜 :于 ”帮助 学 生 观 察 徽 组 织 。 
远程 替身 (Tele- Actor). iT] ^ * fe Yr— £H ^f^ E Rie 
程 指挥 一 个 人 类 替身 来 访问 诸如 半导体 制造 工厂 的 清 
洁 工作 室 和 DNA 分 析 实 验 室 这 样 通常 不 会 对 他 们 开 
放 的 场所 。 


通信 与 网 络 


下 面 是 关于 网 络 的 相关 术语 和 技术 的 简短 回顾 。 
如 果 需 要 更 多 细节 ， 见 参考 文献 [32. 42 ] 。 

一 个 通信 网 络 包含 三 个 要 素 : 链接 、 路 由 器 / 交 
换 机 和 主机 。 链 接 指 的 是 将 数据 从 一 个 地 方 传输 到 另 


32. 3 


任意 时 间 通 过 链接 发 送信 息 。 因 此 ， 两 个 或 更 多 的 被 
激活 的 传输 请 求 之 间 可 能 发 生 冲突 。 冲 突 可 以 通过 直 
接 感 知 有 线 网 络 电缆 中 的 电压 变化 来 检测 ， 这 种 方式 
被 称 为 冲突 检测 (CSMA/CD); 或 者 可 以 通过 检查 无 
线 网 络 中 一 个 预期 声明 的 超时 ， 这 种 方式 被 称 为 冲突 
回避 ( CSMA/CA)。 如 果 检 测 到 冲突 ， 所 有 的 发 送 者 
在 重新 发 送 前 随机 等 待 一 小 段 时 间 。CSMA 有 一 些 重 
要 的 属性 : DD 它 是 一 种 完全 的 非 集中 式 的 方法 ; OE 
不 要 求 整个 网 络 的 时 钟 同步 ，@ 它 非常 易于 实现 。 但 
Æ, CSMA 也 有 缺点 : 四 网 络 的 效率 不 高 ; @ 传 输 延 
述 可 能 发 生 激烈 的 变化 。 

如 前 面 提 到 的 ， 各 个 局 域 网 通过 路 由 器 /交换 机 
连接 在 一 起 。 信 息 通过 包 的 格式 传递 。 一 个 包 是 一 个 
若干 比特 (bit) 的 字符 串 ， 通 常 包 含 了 源 地 址 、 终 点 
地 址 、 数 据 包 长 度 和 校 验 。 路 由 器 /交换 机 根据 它们 的 
路 由 表 分 发 这 些 包 。 路 由 器 /交换 机 没有 对 这 些 包 的 记 
忆 ， 这 是 整个 网 络 的 可 观测 性 的 保证 。 与 具体 应 用 独 
立 ， 包 通常 由 先进 先 出 (FIFO) 原则 进行 路 由 。 包 的 
格式 和 地 址 与 主机 技术 独立 ， 这 保证 了 可 拓展 性 。 这 
个 路 由 机 制 给 出 了 网 络 中 包 交 换 的 准则 。 它 与 传统 的 
电话 网 络 非常 不 同 ， 后 者 是 一 种 回路 交换 。 电 话 网 络 
的 设计 是 为 了 保证 在 打 电 话 时 ， 发 送 者 和 接受 者 之 间 
建立 起 专用 的 回路 。 这 种 专用 回路 保证 了 通信 的 质量 。 
但 是 ， 它 要 求 大 量 的 回路 来 保证 服务 质量 (QoS) ， 而 
这 导致 了 整个 网 络 利 用 率 不 高 。 包 交换 网 络 不 保证 每 
一 对 数据 传输 者 之 间 的 专用 带宽 ， 但 它 改善 了 总 的 资 
源 利用 率 。Internet 作为 使 用 最 为 广泛 的 通信 媒介 和 网 
络 遥 操作 机 器 人 的 基础 设备 ， 是 一 种 包 交换 网 络 。 


32.3.1 Internet 网 络 


Internet 的 诞生 可 以 追 漳 到 20 世纪 60 FRÆ H 
国防 部 的 APRANET 网 络 。APRANET 网 络 有 两 个 特 
性 使 得 它 可 以 作为 一 种 成 功 的 Internet 解决 方案 。 其 
一 是 它 具 有 数据 ( 包 ) 传输 失败 时 的 重 路 由 能 
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这 最 初 是 为 了 保证 核 战 争 时 的 通信 。 有 趣 的 是 ， 这 种 
动态 路 由 能 力也 使 得 Internet 的 拓扑 结构 更 容易 成 长 。 


其 二 是 它 具 有 连接 不 同 的 异 构 网 络 的 能 力 。 各 种 异 构 
网 络 ， 如 X. 25 、G. 701、 以 太 网 ， 只 要 它 可 以 应 用 网 


际 协 议 (IP), ， 就 可 以 连接 到 Internet E, IP 与 媒体 、 
操作 系统 和 数据 传输 率 无 关 。 这 种 灵活 的 设计 允许 多 
种 应 用 和 主机 连接 到 Internet 上 ， 只 要 它们 可 以 生成 
和 理解 IP。 
图 32. 3 展示 了 Internet 使 用 的 四 层 协议 模型 。 

层 上 面 的 是 两 个 Hosts ipa die n 
(TCP) 和 用 户 数据 协议 (UDP), TCP 是 一 个 终端 到 
终端 的 传输 控制 协议 。 基 于 数据 包 往 返 时 间 ， 它 管理 
着 包 的 排序 、 差 错 控 制 、 速 率 控制 和 流 控制 。TCP 保 
证 了 每 个 包 的 到 达 。 但 是 ， 在 一 个 拥塞 网 络 中 ，TCP 
方式 的 大 量 数据 重 发 送 可 能 导致 网 络 机 器 人 系统 中 不 
可 预期 的 时 延 。UDP 则 是 一 种 不 同 的 机 制 : 它 是 一 
个 具有 广播 能 力 的 协议 ， 没 有 重 发 送 机 制 。 用 户 必须 
自己 处 理 差错 控制 和 速率 控制 。 和 TCP 相 比 ，UDP 
的 总 开销 少 很 多 。UDP 方式 中 ， 数 据 包 由 用 户 预 设 
的 速率 传输 ， 该 速率 根据 网 络 拥塞 状况 发 生 改 变 。 
UDP 方式 有 更 大 潜力 ， 但 因为 缺少 速率 控制 的 机 制 ， 


这 种 连接 方式 常常 被 防火 墙 阻隔 。 值 得 一 提 的 是 ， 通 
a TCP 和 UDP 
一 系列 协议 。 


SSH/ 
HTTP SFTP SMTP Pree H.263 | TFTP 


X.25, G.701, Ethernet, token ring, FDDI, Tl, ATM 


图 32.3 Internet 协议 的 四 层 模 型 
(按照 参考 文献 [32.42 ] ) 


在 Internet 的 应 用 层 协议 中 ，HTTP 是 其 中 最 重 
要 的 协议 之 一 。HTTP 是 一 个 用 于 万 维 网 (WWW) 
的 协议 ， 它 允许 在 不 同 的 异 构 主 机 和 操作 系统 之 间 分 
享 多 媒体 信息 ， 如 文本 、 图 像 、 音 频 和 视频 。 这 一 协 
议 为 Internet 的 发 展 做 出 了 极 大 贡献 。 它 还 改变 了 通信 


架构 ,使 之 从 传统 的 客户 端 /服务 器 (Client/Server, 
C/S) 形式 转变 为 浏览 器 /服务 器 (Browser/Server, B/ 
S) 形式 。 一 个 典型 的 B/S 架构 包含 了 一 个 web 服务 
器 和 带 有 网 络 浏览 器 的 客户 端 。 服 务 器 通过 超 文本 置 
标语 言 (HTML) 格式 或 是 它 的 使 用 HTTP 在 Internet 
上 进行 数据 传输 的 变 体 来 建立 内 容 。 用 户 的 输入 可 以 
在 通用 网 关 接 口 (CGI) 或 是 其 他 变 体 上 获得 。BVS 
架构 是 最 为 易 用 的 ， 因 为 它 不 需要 在 客户 端 安装 特殊 
软件 。 


32. 3. 2 


有 线 传输 链接 


即使 在 使 用 状况 的 最 高 峰 ，Internet 的 网 络 骨 
的 使 用 率 还 不 到 总 能 力 的 30% 。 a 
15% ~20% 之 间 。Internet 传输 速度 最 大 的 限制 在 于 
最 后 一 公里 ， 即 客户 端 和 它们 的 Internet 服务 供应 商 
(ISP) 之 间 的 链接 上 。 

表 32.1 列 出 了 不 同 连接 方式 的 典型 比特 率 。 需 
要 指出 的 是 ,在 许多 例子 中 速度 都 是 不 对 称 的 ， 上 行 
比特 率 (从 客户 端 到 Internet) 比 下 行 速度 (从 Inter- 
net 到 客户 端 ) 要 慢 很 多 。 这 种 不 对 称 性 导致 了 遥 操 
作 网 络 模型 的 复杂 性 。 由 于 在 最 慢 的 modem 连接 到 
最 快 的 Paternet， 两 节点 之 间 的 速度 差距 达到 10000 
倍 以 上 ， 网 络 遥 操作 机 器 人 系统 的 设计 者 必须 考虑 到 
这 种 传输 速度 的 极 大 不 同 。 


表 32.1 按 有 线 连接 类 型 归纳 的 最 后 
一 公里 Internet 速度 
(在 非特 殊 的 情况 下 ， 下 行 传输 和 


上 行 传输 有 相同 的 带宽 ) 


类 型 每 秒 比 特 数 
Dal til ROS wd C 
最 高 为 56K 
(V.92) 
综合 业务 数字 网 
64 ~128K 
(ISDN) BRI 
高 速 数 字 用 户 线 
高 速 数 字 用 户 线 yy 双 工 双 绞 线 
( HDSL) 
非 对 称 数字 用 户 1.544 ~ 6.1M 下 行 ，16 ~ 640K 
线 (ADSL) Ef 
电缆 调制 解 调 器 | 2-4M Ffi, 400-600K 上 行 
光纤 到 户 (FTTH) | 5 ~30M 下 行 ， 2 ~5M 上 行 
D 1 = 于 : 担 Ht 
ERPS >1G (数据 基于 Verizon 所 提供 的 


服务 ) 
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32.3.3 ”无线 链接 


表 32.2 比较 了 到 2006 年 的 不 同 的 无 线 标准 之 间 
速度 、 频 段 和 有 效 距 离 的 差异 。 增 加 比特 率 和 传输 距 
离 需 要 增 大 功率 。 距 离 d 以 上 的 射频 (RF) 传输 需 
要 的 功率 值 与 4 成 正比 ， 其 中 ，2 三 5 过 4， 由 天 线 类 
型 决定 。 表 32. 2 中 ， 蓝 牙 和 Zigbee 是 典型 的 低 功 耗 


传输 标准 ， 适 合 短 距 离 使 用 ，WiMax 和 MWBA 现在 
正在 开发 中 。 

表 32.2 无 线 技术 的 比特 率 和 传输 距离 的 概况 

类 型 比特 率 /(bit/s) 带宽 /Hz 范围 /m 

Zigbee 

20-250K |868~915M/2.4G| 50 

(802. 15.4) 

3G 手机 400K ~1. 15M x3.5G 15 000 

蓝牙 732K 2.4G 100 

MWBA 

1M <3.5G 15 000 
(802. 20) 
WiFi : 
11 ~54M 2.4G 35. 8G 100 

(802.11a, b, g) 

WiMax 2-116, 

70M 50 000 

(802. 16) 10 - 66G 

由 于 提供 低 功 耗 下 的 高 速 连接 能 力 ，WiFi 成 为 
T 2006 年 最 流行 的 无 线 标准 。 它 的 传输 距离 在 100m 


Zh, Wiki 无 线 网 络 通常 由 小 范围 内 的 互联 接 人 点 
组 成 。 覆 盖 距 离 有 限 使 这 种 网 络 被 限制 在 办 公 建 筑 、 
家 用 或 其 他 室内 环境 中 。WiFi 对 于 室内 使 用 的 移动 
机 器 人 和 其 人 类 操纵 者 是 个 不 错 的 选择 。 如 果 机 器 人 
需要 室外 环境 中 的 导航 ， 第 三 代 (3G) 手机 网 络 能 
提供 最 好 的 可 用 覆盖 网 络 。 尽 管 关 于 覆盖 范围 和 带宽 
的 问题 有 明显 重复 ， 表 32. 2 还 有 两 个 重要 的 问题 没 
有 提 及 。 其 一 是 移动 性 。 我 们 知道 ， 如 果 一 个 射频 的 
发 射 源 或 者 接收 器 在 移动 ， 根 据 多 普 勒 效应 电波 的 频 
率 会 发 生变 化 ， 这 在 通信 中 可 能 导致 一 些 问题 。WiFi 
并 不 是 为 高 速 移动 的 主机 设计 的 。WiMax 和 3G 手机 
网 络 允许 主机 随 速 度 低 于 120km/h 的 车 辆 移动 。 不 
过 ，MWBA 允许 主机 以 250km/h 的 速度 移动 ， 它 是 
能 在 高 速 铁路 上 工作 的 协议 。WiMax 和 MWBA 
的 传输 延迟 都 被 设计 为 低 于 20ms。 而 3G 手机 网 络 的 
延迟 在 10 ~500ms 之 间 变 化 。 


网 络 遥 操作 机 器 人 的 属性 


根据 Mason, Peshkin A Efl AU 给 出 的 定 
义 ， 准 静态 机 器 人 系统 中 ， 加 速度 和 惯性 力 与 耗 散 力 


32. 3. 4 


相 比 是 可 以 忽略 的 。 在 准 静 态 机 器 人 系统 中 ， 动 作 通 
常 由 离散 的 基本 状态 之 间 的 转换 来 建 模 。 在 网 络 遥 3 
作 机 器 人 问题 中 ， 我 们 采用 类 似 的 术语 。 在 准 静 态 
操作 机 器 人 学 (QT) 中 ， 机 器 人 的 动力 学 和 稳定 | 
是 在 本 地 处 理 的 。 在 每 一 个 基本 动作 执行 完毕 之 后 ， 
一 个 新 的 状态 报告 会 呈报 给 远程 用 户 ， 而 他 将 返回 基 
本 命令 。 基 本 状态 描述 了 机 器 人 的 现状 及 其 所 处 的 3 
境 。 基 本 命令 指 的 是 用 户 的 指令 ， 它 反映 了 期 望 的 机 
器 人 的 动作 。 

是 出 几 个 问题 : 

D 状态 一 命令 的 陈述 : 怎么 通过 二 维 屏 幕 
显示 来 向 远程 人 类 操作 者 表达 状态 及 可 ] 的 


mes 


z 


"b 


pal 


) 命令 执行 /状态 生成 : 怎么 通过 本 地 执行 的 
命令 WO 
3) 命令 协调 : 如 果 存 在 多 个 人 类 操作 者 ， 怎 么 
解决 他 们 之 间 的 命令 协调 问题 ? 


32.3.5 建立 一 个 网 络 遥 操作 机 器 人 系统 
一 个 典型 的 网 络 遥 操作 机 器 人 


如 图 32. 4 所 示 ， 
系统 应 该 包含 三 个 部 分 : 


Sn 


[Or 


图 32.4 ”网络 遥 操 作 机 器 人 的 典型 系统 结构 


1) 用 户 : 任何 接 入 到 Internet 并 拥有 一 个 网 络 
浏览 器 的 人 。 

2) 网 络 服务 器 : 一 台 运 行 网 络 服务 器 软件 的 计 
算 机 。 

3) 机 器 人 : 机 械 辟 、 移 动机 器 人 或 其 他 任何 能 
够 改变 和 影响 环境 的 设备 。 


用 户 通过 他 们 的 网 络 浏览 器 连接 系统 。 任 何 适应 
于 W3C 的 HTML 标准 的 浏览 右 都 能 连接 上 网 络 服务 
器 。 在 2006 年 ， 最 流行 的 网 络 浏览 器 是 Microsoft 
Internet Explorer, Mozilla Firefox, Safari 和 
Opera。 新 的 浏览 句 和 具有 新 特性 的 旧 浏 览 器 的 升级 
版 本 正 不 断 出 现 。 

网 络 服务 器 是 一 台 能 够 响应 Internet 上 HTTP 请 
求 的 计算 机 。 根 据 网 络 服务 器 操作 系统 的 不 同 ， 流 行 


O 


Netscape, 
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操作 与 接口 


的 服务 器 软件 包 有 Apache 和 Microsoft 的 Internet 信息 
服务 (HS )。 大 多 数 的 服务 器 软件 都 能 免费 地 从 
Internet 上 下 载 。 

要 开发 网 络 遥 操作 机 器 人 ， 需 要 开发 、 配 置 和 维 
护 网 络 服务 器 的 基本 知识 。 如 图 32.5 所 示 ， 开 发 需 
要 HTML 和 至 少 一 种 本 地 编程 的 语言 ， 如 C, CGE 
JavaScript, Perl, PHP 或 Java, 


网 络 浏览 器 HTTPD 服 务 器 


网 络 服务 器 


图 32.5 网 络 遥 操作 机 器 人 的 软件 结构 范例 


考虑 不 同 浏览 器 之 间 的 兼容 性 是 一 个 非常 重要 的 
问题 。 尽 管 HTML 是 按照 所 有 浏览 器 都 兼容 的 标准 设 
iR, fBxed PR. PUN, JavaScript, —RPPJTCTE 
浏览 器 中 的 脚本 语言 ， 就 是 不 对 IE Netscape 完全 
兼容 的 。 常 用 的 HTML 组 件 也 是 需要 掌握 的 ， 如 
用 户 输入 的 表格 ， 将 页 面 划分 为 不 同 功 能 区 的 术 
等 。 关 于 HTML 的 介绍 可 以 见 参 考 文献 [32. 45 ] 。 

用 户 命令 通常 是 由 使 用 通用 网 关 接 口 (CGI) 的 
网 络 服务 器 处 理 的 。 最 经 典 的 处 理 方法 有 PHP, JSP, 
套 接 字 编 程 也 是 常用 方法 。 当 有 用 户 通 过 统一 资 
源 定位 符 (URL) 指向 CGI 脚本 时 ，HTTP 服务 器 就 
调用 CGI, CGI 程序 就 开始 解释 输入 (通常 是 给 机 器 


pu 


FD z 


32.3.6 ”状态 一 命令 陈述 


要 生成 正确 和 高 质量 的 命令 ， 取 决 于 人 类 操作 者 
AS Hit 


7 


理解 状态 反馈 的 效率 。 状 态 一 命令 的 陈述 包含 了 三 个 
子 问题 : 机 器 人 实际 状态 的 2-D 表达 (状态 显示 ) , 
用 户 界面 对 生成 新 命令 〈 空 间 推 理 ) 提供 的 辅助 作 
用 ， 以 及 输入 机 制 。 

1. 浏览 器 显示 

与 传统 的 需要 专业 训练 和 设备 的 点 对 点 遥 操 作 不 
同 ， 网 络 遥 操作 机 器 人 提供 了 面向 公众 的 广泛 的 接 和 人 
方式 。 设 计 者 不 能 假设 用 户 预先 有 着 任何 的 关于 机 顺 
人 的 知识 。 如 图 32. 6 所 示 ， 网 络 遥 操作 机 器 人 系统 
需要 在 一 个 2-D 显示 器 上 显示 机 器 人 的 状态 。 
sa snae COT 


Location: [http://www usc edu/cot-bon/ark-sper ator-map /750889960 166644 763,141 


OPERATOR'S SCREEN 


You are Currently Operating the Robot 


ENERGY LEVEL MEN HEN ES HE E SU EN UN UNE NE 


E QUIT Your Turn at Operating the Robot 
View the Operators’ Log 
Go to the Project Home Page 


system processing time: 8 seconds 


图 32.6 58 — 4S P 28 E BR EL ae A RO BY X a ae DE 


人 的 下 一 步 运动 命令 ) ， 并 将 命令 通过 本 地 通信 信道 
发 送 给 机 器 人 。CGI 脚本 可 以 用 几乎 任 一 种 编程 语言 
编写 。 最 常用 的 是 C Perl. 

一 个 简单 的 网 络 遥 操作 机 器 人 系统 可 以 只 用 HT- 
ML 和 CGI 构筑 。 但 是 如 果 需 要 建立 更 好 的 用 户 界 
面 ， 推 荐 使 用 Java Applet, Java Applets 在 客户 端 计算 
机 的 网 络 浏览 器 的 内 部 执行 运行 。 关 于 Java 的 信息 
可 以 在 Sun 微 系 统 公司 的 官方 主页 上 找到 。 

大 多 数 遥 操作 机 器 人 系统 都 收集 用 户 和 机 器 人 的 
信息 。 因 此 ， 数 据 库 设 计 和 数据 处 理 程序 也 是 需 
的 。 最 常用 的 数据 库 包 括 MySQL 和 PostgresSQL。 两 
者 都 是 开源 数据 库 ， 并 且 支 持 多 种 平台 和 操作 系统 。 
由 于 网 络 遥 操作 机 右 人 系统 是 24h 在 线 的 ， 可 靠 性 也 
是 系统 设计 中 需要 考虑 的 重要 问题 。 网 站 安全 非常 重 
要 。 其 他 的 附加 开发 工作 包括 在 线 文 档 、 在 线 手 册 和 
用 户 反 馈 意见 收集 。 


AS. 右边 的 图 显示 了 一 个 四 轴 机 械 臂 的 俯视 图 COR 
端的 摄像 头 标记 为 X) ， 左 边 的 窗口 显示 了 摄像 头 现在 正 
拍摄 的 内 容 。 窗口 左边 有 一 个 小 红 点 的 按钮 可 以 控制 释 
放 1s 的 压缩 空气 ， 冲 开 摄 像 头 下面 的 沙子 。 水 星 计 划 于 
1994 年 8 月 到 1995 年 3 月 在 线 


遥 操 作 机 器 人 的 状态 通常 以 由 物理 世界 的 坐标 系 
或 者 机 器 人 关节 构 型 为 特征 来 描述 ， 并 通过 数字 表格 
或 者 图 像 描述 的 方式 来 显示 。 图 32.6 在 界面 上 列 出 
了 机 器 人 的 XYZ 坐标 系 ， 并 且 绘 制 了 一 个 简单 的 2- 
D 投影 来 显示 关节 构 型 。 图 32.7 显示 了 男 一 个 遥 操 
作 界 面 的 例子 ， 它 是 由 Taylor 和 Trevelyan 开发 
的 3。 在 这 一 界面 中 ，XYZ 坐标 是 由 视频 窗口 边 
的 滑动 条 来 表示 的 。 

机 器 人 的 状态 通常 是 通过 如 图 32.6、 图 32.7 所 
示 的 2-D 形式 来 显示 的 。 在 某 些 系统 中 ， 多 摄像 头 
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可 以 帮助 人 类 操作 者 理解 机 器 人 和 它 周 围 环境 中 的 物 。 T IMWEHS BI CRI "ERE RE RR EET. Su 等 
体 之 间 的 空间 关系 。 图 32. 8 显示 了 一 个 通过 四 个 区 ”人 提出 了 一 种 增 量 式 算法 ， 能 更 好 地 将 操作 者 的 意图 
域 摄像 头 来 观察 一 台 六 自由 度 工业 机 械 臂 的 合子 。 ”和 行为 解释 为 机 器 人 的 动作 命令 和 ” 。 

图 32. 9 展示 了 一 个 可 移动 缩放 的 机 器 人 摄像 头 。 

图 32.9 的 界面 是 为 移动 机 器 人 设计 的 。 


=: 
m: 
人 
«i 
| 
E 
ml 
m; 


图 32. 7 RAAEN ERNEA ERRE (该 机 
器 人 有 一 个 六 关节 机 械 辟 ， 能 拾取 和 移动 小 块 :1 ) 


到 


nme WILD mammam 


sh) Tansienngdaiaionismpcieim #2 + ~~ SOS 


Fd 32.9 Patrick Saucy 和 Francesco Mondada 的 Khep 
计划 中 ， 摄 像 头 控制 和 移动 机 器 人 控制 的 页 面 


[i] hitp://telerobot mech uwa edu mu co wrtelerob exe 


i 2. 人 类 操作 者 输入 

WES i 大 部 分 的 网 络 遥 操作 机 器 人 系统 都 只 需要 鼠标 和 
| 
1 


键盘 完成 输入 。 设 计 中 的 一 个 问题 是 需要 在 界面 上 单 

击 些 什么 。 考 虑 到 用 户 的 命令 可 能 会 非常 不 同 ， 这 里 

| 需要 采用 一 种 适当 的 输入 界面 ， 例 如 ， 输 入 可 以 是 世 

| 界 坐标 系 的 XYZ 笛 卡 儿 坐标 值 ， 也 可 以 是 以 关节 角 
Observe only? F (uncheck to try to gain control) X=599, Y 2278, 22 126, Spin 2 1, Ti 22 度 表示 的 机 器 人 构 型 。 

ee l 对 于 角度 输入 ， 一 般 建议 采用 圆 形 表盘 作为 控 条 

ee eee | 界面， 如 图 32.7 的 左下 部 分 和 图 32.9 的 右边 部 分 。 

| 对 于 笛 卡 儿 坐标 系 中 的 线性 运动 ， 则 建议 使 用 通过 鼠 

eol Ta 四。 标 单 击 或 键盘 来 操作 的 箭头 表示 。 位 置 和 速度 控制 也 


[SEE 是 需要 的 ， 如 图 32. 9 所 示 。 速 度 控制 通常 通过 鼠标 
! 单 击 线性 进度 条 和 表盘 ， 分 别 控制 平移 和 旋转 。 


最 常用 的 控制 方式 是 位 置 控 制 。 最 直观 的 方法 是 


Sorry, you can't play with the robot right now because it is currently being used by Telerobot Team. 


Current position and orientation: 


= 


‘Would you like to read our fabulous tutorial? 


图 32.8 用 一 个 多 摄像 头 系统 完成 直接 单 击 视频 图 像 。 为 了 实现 这 一 功能 ， 软 件 需要 将 
多 视点 的 状态 反馈 T 2-D 的 单 击 转换 成 3-D 的 世界 坐标 值 。 为 了 简化 这 一 


问题 ， 设 计 者 假设 单 击 的 位 置 位 于 一 个 固定 平面 上 ， 
更 多 复杂 的 空间 推理 可 以 在 收 到 人 类 操作 者 的 任 例如 ， 图 32. 10 中 界面 上 的 鼠标 单 击 假设 机 器 人 在 蕊 


务 级 命令 后 自动 生成 命令 序列 ， 以 此 免除 人 类 操作 者 了 平面 上 移动 ， 在 图 像 上 的 鼠标 单 击 的 组 合 人 允许 抽 旬 


提供 底层 控制 的 需要 。 这 对 高 度 动态 和 需要 高 速 反应 的 任务 级 别 命令 。 图 32. 11 中 的 例子 用 鼠标 单 击 图 像 
的 机 器 人 系统 来 说 尤为 重要 。 在 这 种 情况 下 ， 是 不 可 。 来 投票 生成 任务 级 的 命令 ， 引 导 机 器 人 收集 测试 用 的 
能 要 求人 类 来 完成 机 器 人 控制 的 中 间 步骤 的 ， 比 如 ， ”物体 。 


Belousov 等 人 采用 了 一 个 共享 的 自主 性 模型 来 知道 机 如 图 32. 11 所 示 ， 在 远程 环境 中 ， 远 程 参与 者 使 


器 人 捕捉 一 只 移动 的 杆子 ” 5 Fong 和 Thorpe 总 结 ”用 数字 摄像 头 拍摄 图 像 并 发 送 给 所 有 的 参与 者 ， 且 带 
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图 32.10 一 个 基于 网 页 的 遥 操 作 系 统 ， 可 以 
让 机 器 人 捕捉 快速 移动 的 长 杆 LPT 
a) 用 户 界面 b) 系统 结构 


a Voting window - Microsoft Internet Explorer 


Which test agent should we 
add next? 


图 32. 11 远程 参与 者 (Tele- Actor) 系统 的 空间 动态 投 
ERE SU]: 这 是 每 个 用 户 都 能 看 到 的 一 个 空间 动态 
HE (SDV) 界面 


有 相关 的 问题 。 每 个 用 户 都 用 鼠标 单 击 放置 一 个 颜色 
编码 的 标识 (作为 选票 ， 或 者 说 投票 元 素 ) WERK 
像 上 。 用 户 能 看 到 所 有 选票 的 位 置 ， 并 且 可 以 根据 团 
队 的 反映 更 改 他 们 选票 的 位 置 。 通 过 处 理 选票 位 置 可 
以 识别 出 得 到 投票 图 像 上 的 一 个 共识 区 域 ， 将 之 返回 
给 远程 参与 者 。 通 过 这 个 方法 ， 整 个 团队 协同 引导 远 
程 参与 者 的 动作 。 


32.3.7 指令 执行 /状态 生成 


机 器 人 接收 到 指令 并 执行 ， 由 此 产生 新 的 状态 并 
将 其 传送 给 操作 者 。 然 而 ， 传 递 给 机 器 人 的 指令 可 能 
会 出 现 延 时 或 在 传送 过 程 中 丢失 。 此 外 ， 由 于 操作 者 
经 验 不 足 ， 还 可 能 出 现 错误 指令 。 

Belousov 和 他 的 同事 们 验证 了 系统 允许 网 络 用 户 
通过 控制 杆 快速 抓 取 已 经 发 送 给 机 械 臂 的 控制 指 
令 呈 ”1。 受 限于 通信 通道 ,用户 几乎 不 可 能 直接 控 
制 机 械 臂 ， 因 而 计算 机 视觉 以 及 基于 增强 现实 的 本 地 
智能 被 用 来 辅助 操作 者 。 由 于 控制 杆 可 进行 双向 补 
类 ， 因 而 会 出 现 复 杂 的 振荡 。Belousov 等 人 设计 了 共 
享 自治 控制 来 实现 抓 取 。 首 先 ， 操 作者 用 控制 杆 选 择 
期 望 抓 取 的 点 ， 且 抓 取 瞬 间 使 用 机 器 人 和 控制 杆 的 三 
维 在 线 虚拟 模型 。 随 后 ， 抓 取 操 作 通 过 运动 预测 算法 
自动 完成 ， 该 算法 基于 控制 杆 运 动 模型 和 两 个 实时 感 
知 控制 杆 局 部 位 置 的 垂直 相交 摄像 头 的 输入 。 


32.3.8 协同 控制 


当 有 一 个 以 上 的 操作 者 共享 设备 的 控制 权时 ， 需 
要 引入 协调 控制 。 参 考 文献 [32.50] 中 指出 多 操作 
者 能 够 降低 出 错 率 ， 应 对 恶意 输入 ， 利 用 操作 者 不 同 
的 特长 ， 以 及 训练 新 操作 者 。 参 考 文献 [32.51] 将 
远程 协作 机 器 人 定义 为 由 许多 参与 者 同时 控制 的 远程 
机 器 人 ， 将 每 个 参与 者 的 控制 输入 汇总 后 形成 单个 的 
控制 流 。 

当 控 制 输入 为 方向 向 量 时 ， 可 以 采用 加 权 平 均 对 
控制 输入 汇总 YY 。 若 操作 者 的 决策 为 不 同 的 选择 
或 者 在 抽象 的 任务 层 进行 决策 时 ， 则 采用 投票 机 
d. nf 32.12 所 示 ，Goldberg 和 Song 采用 空 
间 动 态 投票 机 制 开 发 了 Tele- Actor 系统 。 配 有 音频 / 
视频 设备 的 人 称 为 Tele- Actor， 受 到 许多 在 线 用 户 共 
同 控制 。 用 户 在 投票 时 间 段 将 其 投票 定位 于 一 幅 
320 x320 像素 的 图 像 上 以 表明 控制 意向 。 服 务 器 统 
计 投 票 图 像 中 投票 最 密集 的 区 域 ， 以 决定 Tele- Actor 
的 下 一 步 动 作 (参见 http: //www. tele- actor. net) 

Song 和 Goldberg'*”3 共 同 研发 了 一 个 可 控 的 摄 
像 头 ， 人 允许 多 用 户 对 摄像 头 参数 进行 共享 控制 ， 如 图 
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32.12 所 示 。 用 户 在 一 幅 风 景 图 中 用 长 方形 标示 感 兴 
趣 的 区 域 。 算 法 根据 用 户 满意 度 函 数 计 算出 最 优 取景 
框架 ， 此 类 问题 称 为 框架 选择 问题 。 

图 32. 12 中 ， 用 户 界面 包括 两 个 图 像 窗 口 ， 下 方 
的 窗口 ( 见 图 32. 12b) 显示 摄像 头 全 部 工作 区 (可 


视 范 围 ) 的 画面 。 用户 通 过 虚 边 长 方形 在 画面 中 选 
定 摄像 头 框架 。 基 于 不 同 用 户 的 要 求 ， 算 法 计算 出 最 
优 的 摄像 头 框架 〈 实 边 长 方形 所 示 ) ， 相 应 地 移动 摄 
Bk, EMEEN AOP (ILA 32. 12a) 显示 实时 
的 视频 图 像 。 


图 32. 12 框架 选择 界面 70] 


32.4 结论 与 展望 

随 着 网 络 机 器 人 技术 的 日 益 成 熟 ， 网 络 机 器 人 将 
逐渐 由 实验 室 进入 人 们 的 日 常生 活 。Song 和 Gold- 
berg. ”最 新 提出 的 自然 环境 协同 天 文 台 (CONE) 
项 目 ， 旨 在 设计 一 个 网 络 化 机 器 人 摄像 头 系统 为 自 
然 科 学 家 们 收集 野外 环境 信息 。 网 络 遥 操作 机 器 人 


AKF) 出 任 主席 ， 通 过 广泛 的 宣传 活动 以 及 100 
名 工业 和 学 术 委 员 的 协作 核查 实验 推进 了 网 络 机 顺 
人 技术 的 研发 和 标准 化 进程 。 韩 国信 息 和 通信 部 也 
宣布 了 一 个 旨 在 开发 基于 网 络 化 机 器 人 的 机 器 人 伴 
但 (URC) JH, 

网 络 遥 操作 机 器 人 技术 使 世界 上 数 以 万 计 的 普通 
人 有 机 会 与 机 器 人 互动 。 网 络 遥 操作 机 器 人 系统 由 于 
要 每 天 24h， 一 周 七 天 甚至 年 复 一 年 保持 在 线 状态 ， 


系统 的 快速 发 展 并 不 仅 限 于 北美 地 区 。 日 本 国际 电 
气 通 信 基 础 技术 研究 所 (ATR) 智能 机 器 人 与 通信 
实验 室 也 宣布 了 由 Norihiro Hagita (ATR) 领导 的 网 
络 化 机 器 人 项 目 。 该 项 目的 任务 是 开发 基于 网 络 的 
智能 机 器 人 用 于 服务 、 医 疗 和 救护 。2005 年 春季 如 
开 的 网 络 化 机 器 人 论坛 由 Hideyuki Tokuda ( 庆 应 义 


因此 工程 设计 存在 许多 挑战 。 此 外 ， 还 出 现 了 以 下 新 
的 研究 难题 。 

1) 新 界面 : 由 于 手机 、 便 携 式 数 字 助 理 
(PDA) 等 便携 式 设 备 计算 能 力 的 提高 ， 网 络 遥 操作 
机 器 人 应 当 能 够 根据 不 同 的 设备 改变 界面 类 型 。 随 着 
计算 机 技术 的 日 益 强 大 ， 计 算 机 已 经 能 够 显示 更 为 复 
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杂 的 传感器 输入 信息 。 新 界面 的 设计 也 应 该 追踪 触 党 
交互 界面 、 语 音 识别 系统 等 硬件 技术 的 最 新 发 展 。 动 


Mj (flash)、 可 扩展 标记 语言 (XML) 、 可 扩展 超 文 


bid 


够 处 至 


(VRML) 以 及 无 线 标记 语言 (WML) 
准 也 将 改变 界 
2) 新 算法 : 算法 决定 性 能 。 可 扩展 的 算法 能 


己 语 言 ( XHTML)、 虚 拟 现 实 建 模 语 言 
等 新 的 软件 标 


和 设计 的 方式 。 


LE 如 视觉 / 传 感 等 包含 大 量 数据 的 网 络 输入 。 


此 外 ， 


能 够 利用 分 布 式 并 行 计算 等 日 新 月 异 的 硬 


件 计算 能 力 对 网 络 遥 操作 机 器 人 技术 的 发 展 越 来 
越 重 要 。 

3) 新 协议 : 尽管 我 们 列举 了 一 些 致力 于 改变 
网 络 环境 以 改进 遥 操 作 的 开创 性 工作 ,但 仍然 存 
在 大 量 的 开放 性 问题 ， 如 新 的 协议 、 合 适 的 带宽 


ay fie? 


255]. QoS? 56). 网 络 安全 、 BE p BIL dap 92282 


等 。 网 络 通信 和 领域 的 发 展 日 新 月 异 ， 网 络 通信 技 
术 与 网 络 遥 操作 机 器 人 系统 设计 的 融合 /修订 仍 是 


热点 研究 方向 。 


公共 对 象 请 求 代 理 (CORBA) 或 


实时 CORBA? 295 对 网 络 下 操作 机 器 人 技术 
有 巨大 的 利用 潜力 。 


4) 应 用 : 新 的 应 用 领域 包括 安全 、 


视察 、 教 育 


及 娱乐 。 可 靠 性 、 安 全 性 以 及 模块 化 等 应 用 要 求 将 继 
续 给 系统 设计 带 来 新 的 挑战 。 
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虽然 自主 机 器 人 系统 在 结构 化 环境 〈 如 工矿) 
中 表现 出 色 , 但 是 ， 在 需要 高 度 适应 性 的 非 结构 化 
环境 中 ， 人 一 机 集成 化 系统 大 大 优 于 任何 自主 机 带 
人 系统 。 与 外 骨骼 系统 和 人 体力 量 增 强 相关 的 技术 
可 分 为 下 胶 外 骨骼 机 器 人 和 上 胶 外 骨骼 机 器 人 。 这 
样 分 类 的 原因 有 两 方面 : 首先 ， 可 以 预见 ， 在 不 入 
的 将 来 会 出 现 许多 关于 独立 的 下 及 和 上 胶 外 骨骼 的 
应 用 。 其 次 ,对 于 这 种 分 类 更 重要 的 是 ， 这 些 外 骨 
骼 系统 的 发 展 正 处 于 早期 , 仍 需 要 进一步 的 研究 ， 
以 确保 在 尝试 整合 上 上 肢 外 上 骨骼 和 下 及 外 骨髓 之 前 ， 
二 者 可 以 独立 正常 运行 。 本 童 首先 描述 在 上 上肢 外 肯 
骼 方面 的 工作 ， 随 后 将 更 加 详细 地 描述 下 上肢 外 


JEL, 
H HF o 


33.1 外 骨骼 系统 简 述 


20 世纪 60 年 代 初 ,美国 国防 部 对 开发 人 力 放大 
装置 (man-amplifier) 表现 出 了 兴趣 ， 这 种 设备 是 一 
种 用 于 增强 士兵 举 升 和 搬运 能 力 的 电动 铠甲 。1962 
年 ， 美 国 空军 要 求 康 奈 尔 航空 实验 室 研究 将 主 一 从 机 
器 人 系统 作为 人 力 放 大 装置 的 可 行 性 。 在 其 后 的 工作 
中 ， 康 奈 尔 航空 实验 室 确定 : 外 骨骼 能 够 胜任 绝 大 多 
数 任务 ， 这 种 具有 人 体形 状 的 外 部 结构 的 自由 度 远 少 
FAR ELE BEP U 。 从 1960 年 到 1971 年 ， 通 用 电 
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者 之 间 通 过 革 固 定 带 、 护 腕 和 紧身 外 套 固定 。 该 装置 由 


外 部 动力 驱动 、 预 定 的 周期 性 运动 控制 。 尽 管 这 些 早 期 
装置 由 于 预定 运动 的 限制 而 仅 取得 一 定 成 功 ， 但 是 为 此 
发 展 出 的 平衡 算法 至 今 仍 用 于 许多 双 足 机 器 全 。 

Seireg 等 人 也 开发 出 了 一 种 用 于 截瘫 病人 的 外 骨 
HEARSE (DLE 33. 1 b)， 仅 有 和 髋 部 和 膝 部 在 矢 状 面 上 
被 液压 致 动 器 驱动 。 液 压 动力 单元 由 以 电池 为 电 
源 的 直流 电动 机 、 泵 和 蓄电池 组 成 。 一 系列 的 伺服 立 
驱动 膝 部 和 髋 部 的 致 动 带 。 该 装置 被 控制 以 跟随 一 组 
关节 轨迹 ， 且 没有 使 用 传递 穿戴 考 信 息 的 传感器 
系统 。 


气 公 司 开发 并 测试 了 一 款 名 为 Hardiman ( 见 图 33.1 
a) 的 人 力 放 大 装置 的 样机 ， 它 是 一 个 主 一 从 系 
8! Hardiman 是 一 款 穿戴 在 操作 人 员 身 体 上 的 
HOV a. Sh ob ae (MOLES) 跟随 内 部 外 骨 
骼 (主机 构 ) 的 运动 ， 而 内 部 外 骨骼 则 跟随 操作 人 
员 运 动 。 所 有 这 些 研究 发 现 : 复制 全 部 人 体 运 动 以 及 
运 
复 


] 主 一 从 系统 是 不 实用 的 。 此 外 ， 人 体感 知 和 系统 
杂 性 中 的 困难 也 使 其 无 法 行走 。 
Vukobratovic 等 人 开发 出 了 一 种 截瘫 病人 使 用 的 主 
ERS BRRR TENERA LIK h 
关节 和 膝 关节 的 液压 或 气压 致 动 器 。 这 些 矫 形 器 与 穿戴 


日 本 筑波 大 学 开发 出 了 一 种 混合 辅助 肢体 (Hybrid 
Assisted Limb, HAL) (SLA 33.1 c) 9 ^ 。 这 种 质量 
H 15kg 的 电池 驱动 套装 探测 髋 部 以 下 、 膝 部 以 上 的 皮肤 
表面 的 肌肉 电信 和 号。 信号 由 传 感 避 拾取 并 被 发 送 至 计算 
机 ， 再 由 计算 机 把 神经 信和 号 转换 为 控制 通 部 和 膝 部 的 外 
骨骼 电动 机 的 信号 ， 有 效 地 放大 肌肉 力量 。 除 肌 电 图 
(EMG) 信和 号 外 ， 该 装置 还 包括 用 来 测量 关节 角度 的 电 
位 器 、 测 量 地 面 反 作用 力 的 力 传感器 以 及 测量 躯干 角度 
的 陀螺 仪 和 加 速度 计 。HAL 的 每 条 腿 通 过 整合 有 谐 波 驱 
动 器 的 直流 电动 机 来 驱动 赐 部 和 腑 部 在 矢 状 面 上 做 弯曲 
或 伸展 运动 。 躁 关节 包含 局 部 自由 度 。 
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图 33.1 a) Hardiman b) 由 Seiveg SA‘) 所 设计 的 用 于 辅助 截瘫 患者 的 外 骨骼 系统 c) HAL 


Yamamoto ^g A P* 
发 了 一 种 外 骨骼 系统 


"为 辅助 护士 照料 病人 而 开 
( 见 图 33.2 a) 。 下 肢 包 括 在 矢 


状 面 上 做 弯曲 或 伸展 运动 的 气压 致 动 器 。 为 了 给 致 动 
器 提供 气压 ， 空 气泵 被 直接 安装 于 各 致 动 器 上 。 使 用 


者 的 输入 是 通过 与 其 皮肤 耦合 的 力 传 感 电 阻 决定 的 。 
通过 力 传 感 电 阻 (FSR) 和 其 他 信息 (例如 关节 角 
HE) 可 以 确定 各 关节 所 需 输入 的 扭矩 。 


图 33.2 a) 用 于 搬 挪 病人 的 外 骨骼 0917 7. 5) RoboKnee 9??? 


Pratt 等 人 发 展 出 
膝 部 支撑 ( 见 图 33.2 


了 一 种 用 于 协助 人 下 蹲 的 动力 
b) ^, Reet AE T METRE 


支撑 的 上 下 部 分 的 线性 串联 弹性 致 动 器 提供 动力 。 这 


种 动力 膝 部 支撑 需要 


日 两 负载 部 分 测量 的 地 面 反作用 


力 。 系 统 采用 了 正 反馈 力 控制 器 来 为 致 动 顺 产生 一 个 
合适 的 力 。 

Kong 等 人 [3 中 开发 了 一 种 完整 的 下 上 肢 外 骨骼 系 
统 ， 用 于 帮助 有 力量 走路 的 人 。 该 系统 的 行动 部 分 
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(系统 分 为 行动 部 分 和 穿戴 部 分 ) 搭载 电气 致 动 器 、 
控制 器 和 电池 ， 以 减轻 外 骨骼 系统 的 重量 。 传 输 系统 
将 动力 从 位 于 行动 部 分 的 致 动 器 传输 给 穿戴 者 的 关 
节 。 该 外 骨骼 系统 由 在 矢 状 面 上 的 髋 部 和 膝 部 提供 动 
力 。 驱 动 该 系统 输入 的 是 一 组 压力 传感器 ， 它 们 用 来 
测量 由 股 四 头 肌 施加 在 膝 部 的 力 。 

Agrawal 等 人 开展 了 关于 容许 减少 摆动 时 功 耗 的 
静态 平衡 腿 部 矫正 器 的 研究 项 目 '*'。 在 被 动 式 的 
版 本 中 ， 该 装置 采用 弹 答 以 消除 装置 连 村 和 人 腿 的 重 
力 。 他 们 通过 实验 表明 ， 该 装置 大 大 减少 了 穿戴 者 所 
需 提 供 的 扭矩 。 


上 肢 外 骨骼 


20 世纪 80 年 代 中 期 ， 伯 克利 的 研究 人 员 启 动 了 
一 些 关 于 上 肢 外 骨骼 系统 的 项 目 ， 名 为 人 力 扩展 装 
置 。 上 上肢 外 骨骼 系统 的 主要 功能 是 人 体力 量 增强 ， 这 
种 增强 是 为 了 操作 笨重 的 物体 。 由 于 上 肢 外 骨骼 系统 
大 多 数 用 在 厂房 地 面 、 仓 库 以 及 配送 中 心 ， 因 此 它们 
悬挂 在 检 架 起 重 机 上 。 正 如 在 后 面 几 部 分 所 看 到 的 ， 
下 上 肢 外 骨骼 主要 用 于 在 操作 者 背负 重 物 (类 似 背 包 ) 
长 途 行走 过 程 中 为 重 物 提供 支撑 。 上 上 肢 外 骨骼 ， 又 名 
辅助 装置 或 人 力 扩展 装置 ， 它 能 够 模拟 出 工人 的 手臂 
和 躯干 部 位 的 力量 。 这 些 力 与 搬运 负载 时 所 需 的 力 不 
同 ， 并 且 通 常 远 小 于 后 者 。 当 工人 使 用 上 肢 外 骨骼 系 
统 来 搬运 负载 时 ， 该 装置 就 承受 了 全 部 重量 ， 同 时 将 
该 重量 通过 自然 的 反馈 方式 将 成 倍 缩小 后 的 重量 值 传 
递 给 使 用 者 。 例 如 ， 对 于 物体 的 20kg 重量 ， 工 人 仅 
需 承 受 2kg， 其 余 18kg 均 由 该 装置 承担 。 这 样 ， 工 人 
仍然 能 够 感受 到 负载 的 重量 并 相应 地 判断 自己 的 动 
作 ， 但 是 他 /她 所 感受 到 的 力 远 远 小 于 没有 使 用 这 种 
装置 时 所 感受 到 的 力 。 又 如 ， 假 设 工人 使 用 该 装置 来 
挪动 一 个 体积 大 的 刚性 物体 时 ， 壁 如 一 根 排 气管 。 该 
装置 向 工人 传递 的 力 使 工人 感觉 这 根 管子 重量 轻 、 体 
积 小 。 这 限制 了 交叉 耦合 的 离心 力 ， 这 些 力 增加 了 搬 
运 刚 性 物体 的 难度 ， 有 时 还 会 损伤 手腕 。 在 第 三 个 例 
子 中 设想 工人 使 用 该 装置 来 操作 一 把 动力 扳手 。 该 装 
置 能 够 减少 并 滤 去 从 扳手 传递 至 工人 手腕 的 力 ， 从 而 
使 工人 只 能 感觉 到 扳手 受到 的 振动 力 中 的 低频 分 量 ， 
而 不 是 过 去 那 种 使 人 疲劳 的 高 频 振动 全 站 。 这 些 助 
力 装置 不 仅 能 够 滤 去 不 应 该 传递 给 工人 的 力 ， 而 且 不 
论 工人 想 在 哪个 具体 方向 上 操作 该 装置 ， 都 能 够 通过 


33.2 


=> 


编程 来 使 其 跟随 某 一 特定 的 轨迹 。 例 如 ， 自 动 化 生产 
线 上 的 工人 正在 使 用 一 助力 装置 将 一 座 椅 移 动 至 轿车 


车 厢 里 的 最 终 装 配 位 置 。 这 个 装置 可 以 将 座 椅 移动 至 


装配 位 置 ， 移 动 轨迹 是 通过 编程 预定 的 ， 移 动 过 程 中 
的 速度 与 工人 对 装置 施加 的 力 的 大 小 成 一 定 比 例 。 尽 
管 工 人 可 能 需要 对 座 椅 的 最 终 位 置 稍 加 注意 ， 但 是 该 
装置 仍 能 够 在 无 需 工 人 引导 的 情况 下 将 座 椅 移动 至 合 
适 位 置 。 上 肢 外 骨骼 系统 对 工人 手臂 的 力量 做 出 反 
应 ， 这 力量 是 有 限度 的 ， 并 且 远 小 于 操作 负载 实际 所 
需 。 有 了 它 ， 自 动 化 生产 线 和 仓库 里 的 工人 就 能 够 极 
大 提高 移动 零件 和 箱子 的 熟练 度 和 准确 度 ， 更 不 要 说 
对 肌肉 力量 要 求 的 显著 降低 。 上 肢 外 骨骼 系统 能 明显 


地 减少 在 工作 场所 中 背 伤 的 发 生 ， 这 也 相应 大 大 减少 
了 每 年 治疗 背 伤 的 支出 。 
上 上 股 外 上 骨骼 系统 是 主要 基于 柔顺 控制 策 


略 ”… ”2 来 设计 的 ， 这 种 控制 策略 依赖 对 人 与 机 器 
间 相 互 作 用 力 的 测量 。 各 种 试验 系统 被 设计 出 来 用 于 
验证 这 些 理论 ， 其 中 包括 用 于 运载 飞机 的 液压 承载 器 
和 为 了 执行 手工 操作 活动 而 建造 的 电动 力 扩 展 咒 
( 见 图 33. 3 和 图 33. 4) 。 


图 33.3 双手 上 上 肢 外 骨骼 会 在 人 手 辟 与 重 物 之 间 人 为 地 
产生 摩擦 力 ， 以 便 使 人 可 以 抓 持 物体 09:292 


R K 
Y a | 


E334 装 有 夹具 的 单 手 上 肢 外 骨骼 ， 
用 于 抓 持 重 物 * 
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33.3 智能 辅助 装置 


智能 辅助 装置 (IAD) 是 增强 人 体能 力 的 非 拟 人 
SER EO EAR RSE OO 中 形式 最 简单 的 。 
图 33. 5 展示 了 一 个 智能 辅助 装置 。 


图 33.5 智能 辅助 装置 : 工业 应 用 的 上 肢 力 量 增 强 器 
中 的 最 简单 的 形式 。 它 能 够 很 好 地 跟随 工人 的 高 速 操 
作 动作 ， 在 此 过 程 中 不 会 阻碍 工人 的 运动 


在 装置 的 项 部， 固定 在 天 花 板 上 、 墙 壁 上 或 是 检 
架 上 的 电力 致 动 器 由 计算 机 控制 ， 它 以 可 控 速 度 精确 
地 移动 一 条 强力 钢 绕 。 与 钢 绕 连接 的 感应 末端 执行 
器 ， 是 人 手 、 智 能 辅助 装置 与 负载 相连 接 的 地 方 。 感 
应 未 端 执行 器 (sensory end-effector) 包括 与 负载 交 
互 的 子 系统 和 与 操作 人 员 交 互 的 子 系统 。 与 负载 交互 


图 33.6 a) 末端 执行 器 b ) 装 有 传感器 


的 子 系统 能 与 多 种 不 同 的 负载 和 抓 握 装置 交互 。 例 
dn. 挂钩 、 吸 盘 、 钳 子 等 可 与 负载 交互 子 系统 连接 
( 见 图 33.6)。 一 般 情况 下 ， 要 抓 握 复杂 的 物体 ， 就 需 
要 制造 特殊 的 工具 系统 ， 并 将 其 与 负载 交互 子 系统 连 
接 。 操作 人 员 交 互 子 系统 包括 符合 人 体 工程 学 的 手柄 ， 
其 上 装 有 高 性 能 传感器 ， 用 来 测量 操作 人 员 施 加 在 手 
柄 上 的 纵向 力 的 大 小 。 表 示 操 作 人 员 力 量 的 信号 传送 
至 控制 智能 辅助 装置 致 动 器 的 计算 机 控制 器 。 通 过 操 
作 人 员 力 量 的 测量 值 和 其 他 计算 ， 该 控制 需 设 定 实现 
升 高 或 降低 钢 缆 所 需 的 速度 ， 以 产生 足够 大 的 机 械 力 
来 辅助 进行 搬运 作业 的 操作 人 员 。 若 操作 人 员 向 上 推 
手柄 ， 辅 助 装置 就 会 举 起 负载 ;者 向 下 推手 柄 ， 辅 助 
装置 就 会 降下 负载 。 负 载 的 准确 移动 使 操作 人 员 只 需 承 
受 根据 预先 编程 设 定 的 负载 力 (加 速度 加 上 重量 ) 中 的 
一 小 部 分 ， 而 其 余 的 大 部 分 将 由 智能 辅助 装置 的 致 动 器 
提供 。 所 有 这 些 过 程 进 行 得 很 快 ， 以 使 操作 人 员 举 升 负 
载 的 力 与 装置 举 升 负载 的 力 很 好 地 同步 起 来 ， 这 样 ， 操 
作 人 员 感 觉 到 的 负载 的 重量 就 明显 减轻 了 。 有 了 这 种 负 
重 分 担 的 概念 ， 操 作 人 员 仍 然 感 觉 到 自己 在 搬运 负载 ， 
但 是 使 用 的 力量 却 远 远 小 于 实际 所 需 。 例 如 ， 承 担 25kg 
的 负载 力 (加 速度 加 上 重量 ) 时 ， 智 能 辅助 装置 支持 
24kg， 而 操作 人 员 仅 需 也 仅 能 够 感受 到 1kg。 有 了 智能 
辅助 装置 的 帮助 ， 一 个 工人 就 能 够 像 他 /她 自己 操作 轻 
量 级 物体 时 无 需 任 何 辅助 一 样 自如 地 操作 任何 物体 。 控 
制 智能 辅助 装置 的 运动 时 ， 无 需 按 按钮 、 敲 键盘 、 扳 动 
开关 或 阀门 ; 使 用 者 的 自然 动作 ， 再 结合 装置 中 的 计算 
机 ， 控 制 了 装置 及 其 负载 的 运动 。 

图 33.6 显示 了 感应 末端 执行 器 在 整个 运行 过 程 
中 都 在 测量 操作 人 员 的 力量 ， 甚 至 在 出 现 负 载 或 印 载 
振动 时 。 


liz 


c ) 传感器 测量 操作 人 员 施 加 在 手柄 上 的 垂直 方向 的 力 
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这 种 鲁 棒 的 感应 末端 执行 器 还 包括 常 闭 式 紧急 停 
车 开关 ， 安 装 在 手柄 上 ， 经 由 信号 电缆 向 控制 器 发 送 
信号 。 如 果 感 应 末端 执行 器 上 的 常 闭 式 紧急 停车 开关 
未 按 下 ( 即 : 若 操作 人 员 没 有 手 握 感 应 未 端 执行 需 
的 手柄 ) ， 即 使 向 感应 末端 执行 器 添加 或 从 其 上 移 除 
人 负载， 装置 也 将 处 于 挂 断 状态 。 

智能 辅助 装置 在 设计 时 引入 了 多 种 租 入 式 安 全 功 
能 。 其 中 最 重要 的 安全 特性 是 : 若 感 应 未 端 执行 句 受 
到 物理 性 限制 而 无 法 向 下 运动 且 被 操作 人 员 向 下 推 


一 一 一 


控制 器 


传 感 系统 


时 ， 钢 缆 不 会 松弛 。 钢 缆 松 弛 将 会 导致 比 延缓 工人 工 
作 更 严重 的 后 果 ; 松弛 的 钢 缆 可 能 会 缠绕 操作 人 员 的 
颈 部 或 手 ， 造 成 严重 的 、 甚 至 致命 的 伤害 。 智 能 辅助 
装置 的 计算 机 中 的 控制 算法 利用 了 多 个 传感器 的 信 
A, DU gie UH 

另 一 种 形式 的 智能 辅助 装置 ( 见 图 33.7) EXE 
有 传 感 手套 ， 用 来 测量 穿戴 者 向 材料 转运 系统 或 要 操 
作 的 物体 任何 部 分 施加 的 力 。 


图 33.7 仪器 化 的 手套 可 使 操作 人 员 在 使 用 起 重 器 械 时 自然 地 举 升 或 降下 物体 ， 这 类 似 于 人 
没有 打开 开关 或 按 下 按钮 时 的 手动 操作 物体 n 


这 种 仪器 化 的 手套 通常 由 操作 人 员 穿 戴 使 用 ， 它 
生成 一 组 信号 作为 手套 和 所 操作 物体 或 材料 转运 系统 
之 间接 触 力 的 函数 。 一 组 表示 接触 力 的 信号 被 以 无 线 
射频 信号 的 形式 传送 到 装置 控制 器 以 产生 控制 信号 。 
命令 信号 以 操作 者 所 施 力 的 函数 的 形式 被 传送 至 装置 
致 动 器 以 向 操作 人 员 提 供 所 需 辅助 以 操作 或 举 升 负 
载 ， 这 样 ， 操 作 人 员 就 仅 提 供 实际 操作 装置 和 重 物 所 
需 力 量 中 的 一 小 部 分 。 对 于 观察 操作 人 员 和 智能 辅助 
装置 的 人 来 说 ， 这 种 互动 看 起 来 的 确 很 神奇 ， 因 为 不 
管 操 作 人 员 是 在 推动 智能 辅助 装置 还 是 要 搬 起 物体 ， 
装置 都 在 响应 操作 人 员 的 触摸 。 


33.4 ”用 于 上 上 肢 外 骨骼 增强 的 控制 结构 


这 里 ,我 们 将 运用 线性 系统 理论 对 智能 辅助 装置 
的 元 件 的 动力 学 特性 进行 建 模 。 这 使 我 们 能 够 得 到 系 
统 特性 的 最 简单 、 最 常用 的 形式 。 关 于 上 上肢 外 骨骼 系 


统 的 非 线 性 、 多 变量 的 模型 ， 更 一 般 的 方法 刊载 于 参 
考 文献 [33.19, 20, 21] 中 ， 其 应 用 情况 如 图 33. 3 
和 图 33.4 所 示 。 图 33. 8 中 方 框图 表示 的 是 基本 的 控 
制 技术 。 
如 前 所 述 ， 末 端 执行 器 中 的 力 传 感 元 件 向 控制 致 
动 器 的 控制 器 传送 信号 。 若 。 是 致 动 器 的 输入 命令 ， 
那么 末端 执行 器 的 线 速度 可 表示 如 下 
v = Ge 4 Sf, (33.1) 
式 中 ，C 是 致 动 器 的 末端 执行 器 的 线 速 度 与 输入 命令 
之 间 的 传递 函数 ; 5 是 致 动 器 的 末端 执行 器 的 线 速度 
v SWAK fo 的 灵敏 度 传递 函数 。" 取 正 数 代表 负 
载 向 下 运动 。 还 要 注意 的 是 ， 由 于 负载 与 末端 执行 器 
相连 ， 负 载 速度 与 末端 执行 器 速度 都 以 式 (33.1) 
中 导出 的 v 表示。 如 果 可 以 为 致 动 器 设计 出 使 S 很 小 
的 闭环 速度 控制 器 ， 那 么 致 动 器 对 线 张力 的 响应 就 会 
很 小 。 速 度 财 环 系统 中 的 高 增益 控制 器 将 使 $ 很 小 ， 
从 而 使 速度 受 线 张力 的 影响 很 小 。 另 外 需要 注意 ， 
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图 33.8 智能 辅助 装置 的 控制 框图 


非 反 向 驱动 减速 器 (通常 具有 高 的 传输 比 ) 会 对 系 
统 产生 小 的 5 值 。 
缆绳 的 张力 fi 可 表示 为 

fa=f+p (33.2) 
式 中 , f 是 末端 执行 器 受到 的 操作 人 员 的 力 ; p 表示 
由 负载 和 末端 执行 器 施加 的 力 ， 这 里 称 为 缆绳 上 的 
载 力 。f 和 p 的 正 数 值 表示 力 的 方向 向 下 。 注 意 此 
p 作用 在 线 强 上 ， 它 等 于 负载 与 末端 执行 器 的 重力 力 
上 惯性 力 


È mx 


uo 


W d 
pecca (33.3) 
式 中 ,处 代表 未 端 执行 器 和 负载 的 重量 之 和 ; K 


dt 
示 末 端 执行 器 和 负载 的 加 速度 。 若 负载 没有 加 速 或 减 
速 ， 那 么 p 就 与 WW 相等 。 测 得 的 操作 人 员 的 力 f 传 至 
控制 器 ， 该 控制 器 发 送 输出 信号 e。 计 算 机 从 了 中 减 
EMER yo JARI fy 的 作用 将 在 后 面 介绍 。 
若 控制 器 的 传递 函数 用 天 表示 ， 则 控制 器 的 输 
Ie 


e=K(f-fy) (33.4) 
把 式 (33.2) 和 式 (33.4) 中 的 有 和。 代入 式 
(33.1) 中 可 得 如 下 关于 末端 执行 器 速度 v 的 等 式 : 

v=GK(f-h) +S(f+p) (33.5) 
人 对 末端 执行 器 或 负载 向 上 的 力 仅仅 在 线 缆 由 于 末端 
执行 器 的 重量 而 拉 紧 时 方 可 测量 。 如 果 末端 执行 器 很 
轻 ， 那 么 人 向 上 的 力 的 完整 数值 范围 就 会 被 测量 手套 
中 的 传感器 忽略 。 为 了 克服 这 一 问题 ， 在 式 (33.4) 
HG) ATER oo WI (33.5) Wr, BAA p 
会 导致 末端 执行 器 向 上 移动 。 假 设 由 操作 人 员 施 加 的 
最 大 向 下 的 力 为 。 青 将 设 定 为 有 ,的 大 约 一 半 。 
肖 去 式 (33.5) PAA, sh (33.6) 即 代 表 负 载 的 
速度 


E 


v = oK( p/m) + S(F +P) 


若 操作 人 员 向 下 推 且 /= f, WU BOY BK ti] PE 
度 为 


(33.6) 


tum = GK( o) esr p) 


若 操 作 人 员 压 根 没有 推 ,， 则 末端 执行 器 或 负载 的 最 大 
向 上 速度 为 


(33.7) 


v= -ek( f) scr) 


于 是 ， 由 于 式 (33.4) PA 的 引入 ， 我 们 就 无 
需 关心 向 上 力 的 测量 。 如 果 5 =0， 向 上 和 向 下 的 最 
大 速度 在 数量 上 是 完全 相等 的 。 然 而 ,， 若 5 不 为 0， 
在 同样 条 件 下 ， 对 于 一 个 给 定 负载 ， 最 大 向 上 速度 量 
会 小 于 最 大 向 下 速度 量 。 对 于 操作 人 员 来 讲 ， 这 是 相 
当 自 然 和 直观 的 。 回 到 式 (33.5)， 可 以 观察 到 ， 操 
作 人 员 向 负载 或 线 缆 施加 的 力 越 大 ， 负 载 或 未 端 执行 
器 的 速度 就 会 越 大 。 利 用 操作 人 员 力 的 测量 值 ， 控 制 
器 为 滑轮 赋予 合适 的 速度 以 产生 足够 的 机 械 力 ， 从 而 
辅助 进行 举 升 作业 的 操作 人 员 。 这 样 ， 末 端 执行 器 就 
能 够 自如 地 跟随 操作 人 员 手 臂 的 运动 。 式 (33.5) 
说 明 当 操作 人 员 施 加 在 物体 上 的 向 下 的 力 增加 或 减少 
时 ， 该 物体 的 速度 也 将 相应 地 增加 或 减少 。 另 外 ， 对 
于 给 定 的 操作 人 员 的 力 ， 物 体 的 重量 的 增加 或 减少 会 
相应 地 引起 物体 向 上 速度 的 减少 或 增加 。 如 图 33.8 
所 示 , 天 可 以 任意 大 。 然 而 , K 的 选择 必须 保证 系统 
的 闭环 稳定 性 。 人 的 力量 /是 人 手臂 阻抗 矿 的 函数 ， 
而 负载 力 则 是 负载 的 动力 学 函数 ， 即 负载 的 重量 和 惯 
性 力 。 可 以 找到 许多 设计 控制 器 传递 函数 OK 的 方法 。 
参考 文献 [33.19] 描述 了 这 类 系统 闭环 稳定 性 的 


条 件 。 


(33.8) 


| 


33.5 智能 辅助 装置 的 应 用 
智能 辅助 装置 坚持 一 个 设计 目标 : 使 与 重复 操作 


有 关 的 受伤 风险 最 小 化 ， 在 保持 鲁 棒 性 和 用 户 友好 性 
的 同时 使 吞吐 量 最 大 化 。 智 能 辅助 装置 被 广泛 应 用 于 
仓库 和 配送 中 心 、 自 动 化 装配 工厂 和 邮政 系统 。 一 项 
对 配送 中 心 仓储 操作 行为 的 研究 表明 ， 码 埃 和 件 货 ， 
装 车 和 伙 车 ， 以 及 把 箱子 放 上 传送 带 或 从 上 面 取 下 来 
是 最 为 常见 的 搬运 工作 。 最 初 对 配送 中 心 的 研究 说 
明 ， 仓 库 和 配送 中 心中 要 搬运 的 物体 主要 是 重量 不 大 
于 27kg 的 箱子 ， 它 们 需要 工人 迅速 地 搬运 (有 时 到 
达 15 箱 /min) 。 在 仓库 中 使 用 智能 辅助 装置 在 减少 由 
于 庞大 的 工人 数量 而 可 能 造成 的 伤害 方面 产生 了 相当 
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大 的 冲击 。 图 33.6 显示 了 配送 中 心中 使 用 智能 辅助 
装置 进行 卸货 作业 的 场景 。 

对 自动 化 生产 线 操作 行为 的 研究 表明 ， 电 池 、 油 
箱 、 保 险 杠 、 仪 表 板 、 排 气 简 和 支承 轴 的 安装 是 能 够 
得 益 于 智能 辅助 装置 的 操作 活动 ( 见 图 33.9) 。 须 使 
用 各 种 负载 接口 子 系统 以 便 连接 多 种 汽车 零件 。 


图 33.9 a) 用 于 邮包 投递 业务 的 IAD 
b) 用 于 汽车 工业 的 IAD 


世界 各 地 的 邮政 系统 都 在 使 用 麻袋 和 托盘 来 盛 放 
信件 、 杂 志和 小 型 邮包 。 这 些 麻袋 和 托盘 经 常 由 邮政 
工作 人 员 手 动 处 理 ， 它 们 经 常 被 成 拥 的 杂志 、 信 封 和 
BREW, Eik 32kg。 总 之 ， 在 所 有 的 配送 中 心 ， 
ABARAT EA RUDE AS Aid; 

1) 麻袋 、 信 件 托盘 以 及 邮 简 的 重负 。 

2) 麻袋 和 包 庄 上 缺少 诸如 手柄 、 扣 眼 或 者 其 他 
对 操作 人 员 有 用 的 接口 部 位 。 

3) 同一 邮政 地 点 的 麻袋 、 
状 、 尺 寸 和 重量 的 不 确定 性 。 

使 用 智能 辅助 装置 能 大 大 降低 工人 进行 重复 性 工 
作 时 坎 患 背 伤 的 风险 。 从 而 大 大 减少 国家 在 治疗 伤 患 
方面 的 支出 。 关 于 抓 握 邮件 麻袋 的 末端 执行 器 ， 请 见 
参考 文献 [33.35, 36]. 


NN 


托盘 以 及 邮 简 的 天 


33.6 ”下肢 外 骨骼 


第 一 套现 场 可 操作 的 下 胶 外 骨骼 (BLEEX) 由 
两 条 附 有 动力 装置 的 拟人 化 的 腿 、 一 个 电源 和 一 副 类 
似 背 包 的 框架 组 成 ， 其 中 的 框架 上 可 装载 各 种 重负 。 
这 套 系 统 为 其 穿戴 者 提供 背负 客观 重量 负载 的 能 力 ， 
并 能 够 以 最 小 的 体力 消耗 克服 备 种 地 形 。BLEEX 可 
以 使 穿戴 者 舒服 地 蹲 伏 ， 弯 腰 ， 左 右 摇摆 ， 扭 转 以 及 


疏 坡 和 下 坡 。 同 时 ， 它 也 可 以 使 穿戴 者 可 以 在 背负 器 
材 和 补给 品 时 穿越 障碍 。 由 于 穿戴 者 可 以 长 时 间 的 背 
负重 量 可 观 的 负载 而 不 会 降低 他 /她 的 敏捷 性 ， 在 这 
种 下 上肢 外 骨骼 的 帮助 下 ， 体 能 效率 显著 提高 。 为 了 解 
决 室外 使 用 时 的 鲁 棒 性 和 可 靠 性 问题 ，BLEEX 的 设 
计 是 ， 当 失去 动力 (如 ; 燃料 耗 尽 ) 时 ， 外 骨骼 系 
统 的 腿 可 以 方便 地 伸 掉 ， 而 剩 下 的 部 分 可 以 当 背 包 那 
样 背负 。 

2004 4E, BLEEX ( 见 图 33. 10) 首次 亮相 于 加 州 
大 学 伯克利 分 校 的 人 体 工程 与 机 器 人 实验 室 。 这 个 初 
版 型 号 中 ，BLEEX 的 负载 力 为 34kg ( 约 合 75lb) ， 超 
出 了 其 穿戴 者 的 背负 极限 。BLEEX 的 独特 设计 提供 
了 一 个 人 体 工程 学 的 、 操 作 性 强 、 机 械 鲁 棒 、 质 量 
轻 、 耐 用 的 设备 以 超越 典型 的 人 体 极限 。 


mede 


图 33. 10 BLEEX 及 其 操作 员 Ryan Steger 
1 一 负载 占据 了 背包 的 上 部 和 动力 单元 周围 “2 一 BLE- 
EX 的 背 疹 与 操作 员 背 心 之 间 的 刚性 连接 3 一 动力 单 
元 和 中 央 计 算 机 占据 了 背包 的 下 部 4 一 连接 BLEEX 
与 操作 员 的 半 刚 性 背心 5 一 其 中 一 个 液压 致 动 器 
6—BLEEX 足 部 与 操作 员 的 皮 靴 之 间 的 刚性 连接 


BLEEX 具有 多 种 潜在 的 应 用 ， 它 能 为 战士 、 救 
灾 队 员 、 消 防 人 员 以 及 其 他 承担 应 急 任务 的 人 员 提 供 
背负 超重 负载 (如 : 食品 、 救 援 器 材 、 急 救 补给 品 、 
通信 器 材 及 武器 ) 的 能 力 ， 而 不 会 由 于 出 力 而 导致 
劳累 。 不 同 于 电影 制作 者 和 科幻 作家 所 炒作 的 那些 不 
真实 的 幻想 性 质 的 概念 ， 伯 克利 分 校 研 制 的 下 上 肢 外 骨 
骼 系统 是 一 套 实 用 、 智 能 的 重 物 搬运 机 器 人 系统 。 我 
们 认为 BLEEX 将 来 能 够 提供 满足 各 种 任务 所 需 的 多 
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用 途 、 可 实现 的 运输 平台 。 

下 上 股 外 骨骼 系统 的 效率 问题 出 自 穿戴 者 的 人 类 
智能 与 外 骨骼 提供 的 力量 优势 之 间 的 综合 效益 ; 换 
名 话说 ， 人 为 外 骨骼 系统 提供 智能 控制 而 外 骨骼 制 
动 带 为 人 的 负重 行进 提供 大 部 分 动力 。 控 制 算法 确 
保 外 骨 骼 能 够 在 人 与 外 骨骼 间 相 互 作用 最 小 的 条 件 
下 与 穿戴 者 的 运动 保持 一 致 。 控 制 策 略 不 需要 对 和 穿 
戴 者 或 者 人 机 接触 处 进行 直接 测量 〈 即 : A 
骼 系统 之 间 无 力 传 感 咒 ) ， 而 是 由 控制 器 基于 外 骨 
骼 传 来 的 测量 值 估 计 如 何 运动 以 使 穿戴 者 感到 很 小 
的 作用 力 。 这 种 过 去 从 未 应 用 于 任何 机 需 人 系统 的 
控制 策略 ， 是 一 种 当 人 与 机 器 接触 位 置 无 法 确定 和 
预知 (HU: 人 与 外 骨骼 系统 之 间 在 多 处 接触 ) 的 条 
件 下 极为 有 效 的 驱动 方法 。 该 控制 方法 不 同 于 上 肢 
外 骨骼 "和 触觉 系统 下 所 采用 的 服从 控 
HOSTS) ， 因 为 本 方法 并 不 需要 在 穿戴 者 与 外 骨骼 
之 间 安 装 力 传感器 。 

外 骨骼 控制 的 基本 原理 是 外 骨骼 需要 快速 地 、 无 
延 地 跟踪 穿戴 者 的 自主 的 或 非 自 主 的 运动 。 这 就 需 
要 对 外 骨髓 上 的 所 有 力 和 力矩 做 出 高 灵敏 度 反 应 ， 尤 
其 是 穿戴 者 所 施加 的 力 。 满 足 这 一 需要 就 会 与 控制 科 
学 的 目标 发 生 直 接 冲 突 ， 这 一 目标 就 是 使 闭环 反馈 系 
统 的 灵敏 度 最 小 化 。 如 果 灵 敏 度 低 ， 外 骨骼 就 不 会 跟 
随 穿戴 者 运动 。 然 而 ， 我 们 应 当 认识 到 ， 最 大 化 系统 
对 外 部 力量 和 力矩 的 灵敏 度 将 导致 系统 鲁 棒 性 的 
损失 。 

考虑 到 这 种 新 的 方法 ,目标 是 为 外 骨骼 开发 出 一 
种 具有 高 灵敏 度 的 控制 器 。 我 们 需要 面 对 两 个 来 自 现 
实 的 问题 : 第 一 是 对 外 力 和 力矩 具有 高 灵敏 度 的 外 骨 
骼 会 对 其 他 不 是 由 穿戴 者 发 出 的 外 力 产生 反应 ， 例 
如 ， 若 有 人 推动 具有 高 灵敏 度 的 外 骨骼 ， 外 骨骼 将 会 
做 出 反应 ， 这 反应 与 穿戴 者 向 其 施 力 时 的 效果 一 样 。 
尽管 在 应 对 其 他 力 的 反应 时 ， 它 无 法 稳定 自身 动作 的 
现实 听 起 来 可 能 是 个 严重 的 问题 ， 但 如 果 确 实 是 这 样 
(如 : 使 用 陀螺 仪 )， 穿 戴 者 会 收 到 来 自 外 骨骼 出 乎 
意料 的 运动 ， 这 样 就 需要 他 /她 费力 去 避免 发 生 这 些 
不 需要 的 动作 。 稳 定 外 骨骼 和 防止 其 对 其 他 外 力 做 出 
响应 的 关键 取决 于 穿戴 者 迅速 运动 的 能 力 (如 : 后 
退 或 者 侧 向 移动 ) 以 便 为 自己 和 外 骨骼 创造 一 个 稳 
定 的 状态 。 为 了 做 到 这 些 ， 需 要 很 宽 的 控制 带宽 以 使 
外 骨骼 能 够 对 穿戴 者 的 自主 动作 和 非 自 主动 作 (如 : 
反射 ) 做 出 响应 。 
第 二 是 具有 对 外 力 和 力矩 的 高 灵敏 度 的 系统 对 
变化 的 鲁 棒 性 不 强 ， 且 系统 精确 度 与 外 骨骼 动力 学 
模型 的 精确 度 成 比例 。 在 伯克利 所 做 的 各 种 实验 系 


N 


In 


统 已 经 证 实 这 种 控制 方法 在 跟踪 穿戴 者 行动 时 完全 
有 效 。 


33.7 外 骨骼 的 控制 策略 


这 里 ， 对 外 骨骼 的 控制 可 以 通过 简单 的 单 自 由 度 
(1 自由 度 ) 的 例子 表示 ， 如 图 33. 11 所 示 。 


图 33.11 简单 的 单 自由 度 外 骨骼 腿 与 操作 员 腿 的 相 

互 作用 。 外 骨骼 腿 具有 臻 动 器 ， 能 够 产生 关于 轴 4 的 

力矩 7。 所 有 操作 员 作 用 于 外 骨骼 的 力 和 力矩 的 总 等 
效力 矩 记 为 d 


图 33. 11 中 示意 性 地 描绘 了 人 腿 依 附 在 处 于 摆动 
的 状态 (不 与 地 面 接触 ) 时 的 单 自由 度 外 骨骼 。 为 
了 简单 起 见 ， 外 骨骼 腿 以 一 刚性 连 杆 表示 ， 它 关于 一 
个 轴 转 动 ， 由 单个 致 动 器 提供 动力 。 在 这 个 例子 中 ， 
有 一 致 动 器 以 4 点 为 轴 产 生 力 矩 。 

尽管 操作 者 被 安全 地 与 外 骨骼 在 足 部 连接 在 一 
起 ,但 是 操作 者 腿 的 其 他 部 分 ， 如 小 腿 和 大 腿 ， 仍然 
能 够 接触 外 骨骼 ， 并 对 其 施加 力 和 力矩 。 由 于 接触 的 
位 置 和 接触 力 (有 时 称 之 为 接触 力矩 ) 的 方向 是 不 
断 变 化 的 ， 因 此 在 分 析 时 ， 将 它们 当做 未 知 量 。 事 实 
上 ,设计 BLEEX 的 首要 目标 之 一 就 是 确保 操作 者 能 
不 受 约束 地 与 外 骨骼 相互 作用 。 因 操作 者 对 外 骨骼 施 
加 力 和 力矩 而 产生 的 等 效力 抢 记 为 d。 

若 忽 略 重力 ， 式 (33.9) 和 图 33. 12 中 的 方 框图 
则 表示 在 忽略 所 有 致 动 器 的 内 部 反馈 下 外 骨骼 的 动力 


学 特性 


v=Gr+Sd (33.9) 
st, GON MOUSE A rU) Er BR ARE v CG 中 
包含 致 动 融 的 动力 学 参数 ) 的 传递 函数 。 在 多 个 致 
动 器 对 系统 产生 受 控 力 矩 的 情况 下 ,Fr 指 致 动 器 作 
用 于 外 上 骨髓 上 的 力矩 矢量 。 这 里 ，G 的 形式 和 致 动 
器 的 内 部 反馈 的 类 型 是 无 关 紧 要 的 。 还 要 留心 的 是 : 
为 了 节省 版 面 空间 ， 所 有 等 式 中 拉 普 拉 斯 算 子 均 


操作 与 接口 


图 33. 12 外 骨骼 的 角速度 用 一 个 致 动 器 的 输入 和 
由 操作 员 作用 于 外 骨骼 的 力矩 的 函数 表示 


式 (33.9) 所 示 的 外 骨骼 速度 受 其 操作 者 所 施 
加 的 力 和 力矩 的 影响 。 灵 敏 度 函 数 S 表示 人 的 等 效力 
和 矩 如 何 影 响 外 骨骼 的 角速度 ; S 将 操作 者 等 效力 矩 d 
呐 射 到 外 骨骼 速度 v。 如 果 致 动 器 已 经 有 某 种 具有 基 
本 稳定 性 的 控制 器 ， 那么 S 的 幅度 会 很 小 ， 并 且 外 肯 
骼 只 会 对 操作 者 或 其 他 来 源 所 施加 的 力 和 扭矩 有 一 个 
很 小 的 回应 。 例 如 ， 致 动 咒 的 高 增益 速度 控制 器 导致 
较 小 的 $ 以 及 随 之 产生 的 较 小 的 外 骨骼 对 力 和 力矩 的 
向 应 。 另 外 ， 非 反 向 驱动 致 动 器 〈 如 : 较 大 的 传输 
有 重合 线 轴 的 伺服 阀 ) 导致 较 小 的 5 EL, 
这 就 使 对 操作 者 的 力 和 力矩 的 响应 较 小 。 
注意 到 4 (操作 者 实际 作用 于 外 骨骼 的 力矩 ) 不 
是 外 源 性 输入 ; 它 是 一 个 操作 者 的 动力 学 特性 和 诸如 


和 触摸 系统 施加 受 控 力 和 力矩 ， 这 仅 含 有 非常 小 的 
不 确定 性 。 然 而 ， 我 们 的 下 胶 还 具有 其 他 主要 的 和 
非 随 意 性 的 功能 ， 像 是 支撑 负载 就 具有 比 行走 具有 
更 高 的 优先 级 。 

3) 一 种 经 过 实验 的 选项 是 把 力 传 感 设备 安装 在 
操作 者 的 鞋底 ， 以 使 它们 能 够 与 外 骨骼 连接 。 由 于 操 
作者 鞋底 的 受 力 在 正常 行走 时 在 后 跟 和 脚趾 之 间 移 
动 ， 所 以 需要 安装 若干 传感器 来 测量 操作 者 的 力 。 理 
想 状 态 下 ， 需 要 在 操作 者 与 外 骨骼 足 部 之 间 建 立 一 个 
力 传感器 矩阵 ， 以 测量 操作 者 在 所 有 位 置 的 各 个 方向 
的 力 ， 即 使 在 实践 中 ， 只 有 一 些 传感器 可 以 适应 : 脚 
趾 、 拇 趾 根 、 足 中 部 和 后 跟 。 这 个 选项 仍然 产生 厚重 
的 鞋底 。 

4) 在 人 正常 行走 时 ,鞋底 的 底面 经 受 循环 性 

的 力 和 力矩 ， 这 会 导致 疲劳 ， 并 且 如 果 传 感 器 没 
有 恰当 地 设计 并 隔离 ,那么 最 终 传 感 器 将 出 现 
错误 。 
由 于 上 述 原因 以 及 我 们 在 设计 各 种 下 肢 外 骨骼 时 
的 经 验 ， 现 有 技术 显然 无 法 为 外 骨骼 所 受 人 下 肢 的 力 
提供 鲁 棒 和 可 重复 的 测量 。 我 们 目的 就 成 了 开发 一 种 
1 c i E 
息 只 由 外 骨骼 测量 得 到 CB. 操作 者 身体 或 外 骨 


操作 者 的 位 置 和 速度 的 变量 的 函数 。 这 些 动力 学 特性 
因 人 而 异 。 而 对 于 同一 个 人 来 说 ， 它 是 时 间 和 位 姿 的 


函数 。 这 里 假设 d 均 来 自 于 操作 者 ， 并 且 不 包含 任何 
其 他 外 力 和 力矩 。 

我 们 的 目的 是 增加 外 骨骼 对 操作 者 通过 反馈 的 力 
和 力矩 的 灵敏 度 而 不 用 测量 4。 为 测量 d 而 设计 的 系 
统 产 生 了 一 些 困 难 的 问题 ， 然 而 最 终 是 可 以 解决 的 。 


这 些 问题 主要 是 下 肢 外 骨 髋 的 控制 问题 。 下 面 简要 列 
出 一 些 这 类 问题 。 
1) 根据 外 骨骼 的 架 BAR, 需要 安装 若干 力 


传感器 和 力矩 传感器 来 测量 所 有 来 自 操作 者 的 力 ， 因 
为 操作 者 与 外 骨 澡 在 多 处 接触 ， 这 些 位 置 还 是 未 知 
的 。 例 如 ， 我 们 发 现 一 些 操作 者 习惯 把 支架 在 小 腿 处 
于 外 骨骼 连接 起 来 而 男 外 一 些 操 作者 则 习惯 于 连接 在 
大 腿 。 在 腿 部 加 载 传感器 来 测量 所 有 类 型 的 人 体 的 力 
和 力矩 可 能 会 获得 比较 适用 于 实验 室 场合 的 系统 ， 但 
是 在 户外 场合 ， 则 显得 不 够 鲁 棒 。 

2) 如果 外 骨 散 的 设计 将 操作 者 作用 于 外 骨骼 的 
力 和 力矩 限定 在 一 些 特定 的 位 置 (如 ， 操 作者 足 
WB), ， 那 么 测量 这 些 力 和 力矩 的 传感器 也 将 不 可 避 
免 地 测量 到 其 他 力 和 力矩 ， 而 这 些 力 和 力矩 在 运行 
时 并 不 需要 。 这 是 一 个 测量 诸如 人 手 和 人 下 胶 的 力 
之 间 主 要 的 差别 。 我 们 可 以 通过 双手 向 上 肢 外 骨 铝 


的 变量 处 设置 反馈 ， 如 图 33. 13 所 示 ， 新 的 闭环 灵敏 
度 传递 函数 为 式 (33. 10) 。 


SNEN = 二 = (33. 10) 


图 33. 13 ”附加 到 图 33. 12 中 框图 的 反馈 控制 回路 ; 
C 是 控制 器 ， 只 对 外 骨骼 的 变量 进行 运算 


IÈ (33.10) 显示 Sq SS, 于 是 从 外 骨骼 引出 
的 任意 负 反 馈 将 产生 一 个 更 加 小 的 灵敏 度 传递 函数 。 
考虑 式 (33. 10) ， 我 们 的 目标 是 设计 控制 器 ， 使 对 
给 定 的 S 和 G， 在 一 些 有 界 的 频率 范围 从 d 到 vw 
(EÈ (33.10) 给 出 的 新 的 灵敏 度 函 数 ) 闭环 响应 比 
开 环 灵敏 度 传递 函数 大 。 这 些 设计 指标 由 下 面 的 不 等 
式 (33.11) 给 出 
[Sus | > [S], Vwe (0,0, ) 


(33. 11) 
或 


|1+6C|<1,Vwe(0,a,) (33. 12) 
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SU, wy) 是 外 骨骼 的 操作 带宽 。 

在 经 典 控制 理论 和 现代 控制 理论 中 ， 使 用 所 有 努 
力 以 使 系统 对 外 力 和 力矩 的 灵敏 度 函 数 最 小 化 。 但 是 
对 于 外 骨骼 的 控制 ， 需 要 一 个 完全 相反 的 目标 : 使 系 
统 对 外 力 和 力矩 的 灵敏 度 函 数 最 大 化 。 在 经 典 的 伺服 
控制 问题 中 ， 大 增益 的 负 反 馈 在 带宽 内 一 般 会 产生 小 
的 灵敏 度 ， 这 就 意味 着 可 以 抗拒 力 和 力矩 (通常 称 
为 扰动 ) 。 但 是 ， 上 述 分 析 表 明 外 骨骼 控制 器 需要 对 
力 和 力矩 的 高 灵敏 度 。 

为 了 实现 高 灵敏 度 函数 ， 建 议 使 用 外 骨骼 的 逆 动 
力学 作为 正 反 馈 ， 这 样 就 使 外 骨髓 的 反馈 增益 达到 1 
(上 略 小 于 1)。 假设 引入 了 正 反 馈 , 3X (33.10) 就 可 
以 写成 


N 


v S 

Snew =“ 71-66 
若 C 按 C=0.9G7' 选 定 ， 那 么 新 的 灵敏 度 传递 函数 就 
是 Sypw 108 (将 力 放 大 十 倍 ) 。 我 们 通常 推荐 在 正 
反馈 中 选 定 控制 器 参数 为 

C(1-a^!)c^ (33. 14) 
式 中 , a 是 大 于 1 的 放大 数 (对 上 例 ，a = 10 使 我 
们 必须 选 定 C = 0.967'), BR (33.14) 简明 地 表示 
了 正 反馈 控制 器 需要 选 为 系统 动力 学 经 (1 -a ') 
放 缩 后 的 闭 动 力学 。 注 意 式 (33.14) 描述 了 在 不 考 
虑 未 建 模 的 高 频 外 骨骼 动力 学 时 的 控制 器 。 实 际 上 ， 
C 也 包括 了 一 个 单位 增益 的 低 通 滤波 器 ， 用 它 来 减弱 
外 骨骼 中 未 建 模 的 高 频 动 力学 。 

如 果 设 计 人 员 对 系统 模型 ( 即 : C) 了 解 得 很 完 
整 ， 那 么 上 述 方法 工作 正常 。 如 果 对 系统 模型 了 解 得 
不 够 ,那么 系统 的 性 能 与 式 (33.13) 中 的 描述 就 会 
相差 很 大 ， 在 某 些 情况 下 ， 会 出 现 系 统 不 稳定 的 现 
象 。 上 述 的 这 种 简略 解决 方案 付出 了 高 易 的 代价 : 对 
系统 参数 变化 的 鲁 棒 性 。 为 了 使 上 述 方法 正常 运行 ， 
需要 很 好 地 了 解 系统 的 动力 学 ， 因 为 控制 器 的 建 模 极 
其 依赖 系统 模型 。 可 以 把 这 个 问题 看 做 某 种 折 中 : 上 
述 的 设计 方法 在 操作 者 与 外 骨骼 接触 处 不 需要 传感器 
(例如 : 力 传感器 或 表面 肌 电 传感器 ) ; 操作 者 可 以 
在 任意 位 置 向 任意 方向 推拉 外 骨骼 而 无 需 测量 接触 处 
的 任何 变量 。 然 而 ， 控 制 算法 需要 一 个 很 好 的 系统 模 
型 。 这 时 ， 对 外 骨骼 的 实验 表明 ， 这 种 没有 使 外 骨骼 
稳定 的 控制 策略 ， 迫 使 系统 跟随 人 在 搬运 重 物 时 的 高 
宽 的 操控 动作 。 我 们 已 经 认识 到 ， 正 如 弗 雷 德里 
希 . 尼采 所 说 ， 那 些 不 稳定 的 事物 ， 只 能 使 我 们 更 强 
大 。 人 参考 文献 [33.37] 描述 了 BLEEX 的 系统 辨识 
方法 。 

操作 者 的 动力 学 特性 如 何 影响 外 骨骼 的 行为 呢 ? 


(33. 13 ) 


在 控制 策略 中 ， 我 们 没有 必要 包含 操作 着 肢体 模型 的 
内 部 组 成 部 分 ; 神经 传 到 动力 学 的 细节 ， 肌 肉 的 收 
缩 ， 以 及 中 枢 神 经 系统 的 处 理 过 程 在 建立 操作 者 肢体 
动力 学 模型 时 被 毫 无 保留 地 考虑 了 进来 。 操 作者 对 外 
骨骼 施加 的 力 4 是 操作 者 的 动力 学 HH 和 操作 者 肢体 
运动 学 (例如 : 速度 、 位 置 或 者 此 二 者 的 组 合 ) 的 
函数 。 一 般 地 ,五 主要 由 人 体 动 力学 的 物理 性 质 决 
定 。 这 里 假设 五 是 一 个 代表 操作 者 阻抗 的 非 线 性 算 
子 ， 它 可 以 表示 为 如 下 的 函数 

d= -H(v) (33.15) 
五 的 特定 形式 是 未 知 的 ， 除 非 它 导致 了 人 体 肌 肉 向 外 
骨骼 施 力 。 图 33. 14 表示 向 图 33. 13 中 的 方 框图 中 加 
入 操作 者 动力 学 的 闭环 系统 特性 。 


图 33.14 显示 外 骨骼 如 何 运动 的 框图 。 上 部 的 回 
路 显示 操作 员 如 何 通过 施加 力 使 外 骨骼 运动 ， 下 部 
的 回路 显示 控制 器 如 何 驱动 外 骨骼 


图 33. 14 揭示 了 表示 新 的 外 骨骼 灵敏 度 函 数 的 式 
(33.13) KZRA H 的 反馈 环 影响 。 图 33. 14 展示 
了 外 骨骼 控制 的 一 个 重要 的 特性 。 可 以 观测 系统 中 的 
两 个 反馈 环 。 上 方 的 反馈 环 代 表 操作 者 施加 的 力 和 力 
和 矩 如 何 影响 外 骨骼 。 下 方 的 反馈 环 说 明 受 控 的 反馈 环 
如 何 影响 外 骨骼 。 当 下 方 的 反馈 环 为 正 反 馈 环 ( 具 
有 潜在 的 不 稳定 性 ) 时 ， 上 方 的 反馈 环 使 整个 系统 
保持 稳定 ,该 系统 把 操作 者 与 外 骨骼 作为 一 个 整体 。 
从 参考 文献 [33.38] 中 关于 稳定 性 分 析 的 细节 中 发 
现 , 不 像 上 肢 外 骨骼 中 使 用 的 控制 方法 *” ， 这 里 
所 说 的 控制 方法 中 的 人 体 动力 学 使 系统 不 稳定 的 潜在 
可 能 性 很 小 。 尽 管 包 含有 C 的 反馈 环 是 正 的 ， 但 是 
包含 有 五 的 反馈 环 使 操作 者 与 外 骨骼 组 成 的 整个 系 
统 保持 稳定 。 

上 述 的 讨论 激发 我 们 对 单 自由 度 系统 设计 的 思 
考 。 外 骨骼 是 一 个 具有 许多 自由 度 的 系统 ， 因 此 需要 
进一步 考虑 控制 器 的 实现 。 下 面 我 们 仅 把 上 述 控制 策 
略 扩展 到 单 支撑 的 情形 。 有 关 多 变量 控制 细节 的 描 
述 ， 参 见 参考 文献 [33.38, 39], 

在 单 支撑 的 情况 下 ， 外 骨骼 系统 的 模型 (UL 
2133.15) 在 矢 状 面 上 为 七 自由 度 的 串联 连 杆 
机 构 。 
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图 33.15 矢 状 面 表示 单 足 站 立 期 的 外 骨骼 OEF 
包括 外 骨骼 躯干 机 制 、 负 载 、 控 制 计算 机 和 电源 ) 


外 骨骼 的 逆 动 力学 可 以 通过 下 面 的 通用 形式 写 出 
M(O)6+C(0,0)0+P(0) =T+d 
0=(0 0,0) T= (0,7, 7 
(33.16) 
M 是 一 个 7 x7 惯量 矩阵 ， 它 是 0 的 函数 ; C (0, 0) 
是 一 个 7 x7 的 离心 力 与 科 氏 力矩 阵 ， 它 是 9 和 6 的 函 
数 ; 了 是 一 个 7x1 重力 力矩 矢量 , 它 仅 是 9 的 函数 。 
T 为 一 个 7 x1 致 动 器 力矩 矢量 ， 其 第 一 个 元 素 设 为 
Z, DOE 0, 处 没有 相应 地 制动器 (HU. 外 骨骼 足 
部 与 地 面 的 夹 角 ) ; d 是 一 个 7 x1 力矩 矢量 ， 表 示 操 
作者 施加 在 外 骨骼 上 不 同位 置 的 力矩 。 据 式 
(33.14), ， 我 们 选 定 经 (1-75) 放 缩 后 的 逆 动 力学 
为 控制 器 ， 其 中 a 是 放大 数 。 
T=P+(1-a~')[M(0)6+C(0,6)6] 
(33.17) 


[833.15 r^, €(0, 6), P(0) MMC) 分 别 是 
PRAM Mbit, EER (33.17) 的 结果 是 一 个 
Tx 致 动 咒 力矩 矢量 。 由 于 在 外 骨骼 足 部 与 地 面 之 
间 没 有 致 动 器 ， 那 么 7 中 的 第 一 个 元 素 须 由 操作 者 提 
供 。 用 式 (33.17) 中 的 了 替换 式 (33. 16) 可 得 

M(0)184 C(0,0)0 « P(0) = 


P(0) « (1-a7' ) LM(8)84 C(0,0)0] +d 
(33.18) 


当 上 式 在 M(9) -M(0), C(0, 0) = (0, 6) 和 


P(0) -P(0), o 足够 大 时 达到 极限 ，d 会 趋 近 于 
零 ， 这 就 意味 着 在 行走 过 程 中 ， 操 作者 仿佛 没有 穿 
戴 外 骨骼 一 样 。 然 而 ， 从 式 (33.18) 中 可 以 看 出 ， 


操作 者 感受 到 的 力 是 a 和 佑 计量 C(9, 6), PO) 
和 M(0) 的 准确 度 的 函数 。 一 般 地 ， 系 统 建 模 越 精 


确 ， 需 要 人 的 力量 d 就 会 越 少 。 考 虑 开 合 角度 的 变 
化 ,那么 只 有 式 (33.16) 和 式 (33.17) 中 的 PCA) 
需要 修正 。 

外 骨骼 系统 利用 多 变量 非 线性 算法 来 鲁 棒 地 控制 
其 动作 。 由 于 实现 控制 所 需 的 计算 都 在 一 个 电脑 上 进 
行 ， 所 以 需要 一 个 控制 平台 以 使 系统 信号 线 的 数量 最 
。 新 式 控制 平台 见 参考 文献 [33.40, 41]. 


33.8 下 上肢 外 上 骨骼 设计 中 的 要 点 


c 
a 


若干 因素 需要 在 设计 外 骨骼 时 考虑 到 : 首先 ， 外 
骨骼 不 能 干涉 同属 一 个 工作 空间 的 操作 者 的 运动 ; 其 
次 ， 要 决定 外 骨骼 是 仿 人 的 〈 即 : 运动 学 上 相似 ) ， 
还 是 非 仿 人 的 〈 即 : 运动 学 上 仅仅 在 与 操作 者 的 连 
接 部 位 相 匹配 ) 。 伯 克利 最 终 选 定 了 仿 人 架构 ， 因 为 
这 样 可 以 使 操作 者 清楚 外 骨骼 的 情况 。 另 外 ， 运 动 学 
上 与 穿戴 者 的 腿 部 匹配 的 外 骨骼 能 获得 使 用 者 在 心理 
上 最 大 程度 的 接受 ， 这 样 使 穿戴 更 加 安全 。 结 果 ， 外 
骨骼 被 设计 为 与 操作 者 腿 部 具有 相同 的 自由 度 : 脚跟 
和 髋 部 各 有 三 个 自由 度 ， 膝 部 为 一 个 自由 度 。 这 种 架 
构 也 使 经 过 适当 缩放 后 的 临床 患者 行走 的 数据 能 够 用 
来 设计 外 骨骼 的 各 个 部 件 ， 包 括 工作 空间 、 致 动 器 和 
电源 。 

一 项 临床 步 态 分 析 (CGA) 数据 的 研究 提供 的 
证 据 表 明 ， 人 类 在 行走 、 下 蹲 、 登 台阶 和 大 多 数 的 运 
动 过 程 中 ， 都 通过 中 关节 、 膝 关节 和 通关 节 的 矢 状 面 
释放 大 多 数 的 力量 。 因 此 ， 外 骨骼 的 第 一 版 样机 的 矢 
状 面 关节 被 驱动 。 然 而 ,为 了 节能 ， 咖 关节 和 通关 节 
处 的 非 撩 状 面 的 自由 度 仍然 没有 驱动 。 这 就 迫使 操作 
者 提供 力量 来 驾驭 外 骨骼 外 展 和 旋转 ， 这 些 活动 所 需 
力量 较 小 。 为 进一步 减轻 操作 者 的 负担 ， 未 驱动 的 自 
由 度 加 载 弹簧 来 保持 自然 的 站 立 姿势 。 

典型 的 行走 循环 中 人 关节 的 角度 和 力矩 以 相互 独 
立 的 临床 步 态 分 析 数 据 的 形式 获取 。 临 床 步 态 分 析 中 
的 角度 数据 通常 通过 人 体 移动 的 视频 抓 图 来 获取 。 临 
床 步 态 分 析 中 的 力矩 数据 通过 估计 肢体 质量 和 惯量 、 
再 对 运动 数据 运用 动力 学 公式 来 计算 。 考 虑 到 个 人 步 
态 和 测量 方法 的 差异 性 ， 在 BLEEX 的 分 析 和 设计 中 
使 用 了 三 种 独立 的 临床 步 态 分 析 数 据 源 。 修 正 这 些 数 
据 以 得 到 外 骨骼 的 驱动 需求 的 估计 。 所 做 修正 包括 : 
人 缩放 关节 力矩 至 75kg 的 人 (预计 的 外 骨骼 重量 ， 
其 有 效 载荷 重量 不 包括 其 操作 者 ) ; @ 缩 放 表示 行走 
速度 的 数据 至 每 秒 一 个 循环 (或 者 约 1.3m/s); OH 
骨盆 倾斜 角 与 通关 节 角 相 加 得 到 躯干 与 大 腿 之 间 的 单 
ESE A, QUE 33. 16 所 示 。 这 就 减少 了 外 骨骼 
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的 自由 度 。 接 下 来 的 部 分 叙述 临床 步 态 分 析 的 用 途 及 躁 关 节 的 力矩 通常 是 负 的 ， 这 使 单 向 致 动 器 成 为 
其 在 外 骨骼 设计 中 的 应 用 。 符 号 约定 见 图 33.16 ” 致 动 器 的 理想 选择 。 这 种 非 对 称 也 暗示 了 非 对 称 致 动 
所 示 。 器 的 首选 安装 方向 ( 单 向 液压 氏 )。 相 反 地 ， 如 果 选 
用 双向 致 动 器 ， 那 么 弹簧 负载 就 得 容许 使 用 低 力矩 产 
| 出 的 致 动 器 。 虽 然 躁 关节 力矩 在 站 立时 很 大 ， 但 是 在 
摆 腿 过 程 中 可 以 被 忽略 。 这 提出 一 种 系统 ， 它 能 在 摆 
腿 过 程 中 将 中 关节 致 动 器 从 外 骨骼 系统 释放 以 节省 

com 电力 。 
瞬时 躁 部 机 械 能 〈 见 图 33. 19) 可 由 关节 角速度 
( 见 图 33.17) 与 瞬时 关节 力矩 (SLPS 33. 18) 相 乘 
计算 得 出 。 躁 部 在 站 立 阶 段 吸 收 能 量 、 在 脚趾 离 地 前 
躁 部 平均 功率 为 正 值 ， 这 表示 功率 产 出 是 


-0 踩 


图 33. 16 各 关节 角度 被 测量 为 : 从 邻近 连 杆 ( 站 立 

姿态 时 为 0 ) 始 ， 末 端 连 杆 的 逆 时 针 位 移 为 正 ， 人 体 

如 图 所 示 。 图 中 所 示 的 位 置 ， 髋 关节 角度 是 正 的 ， 

而 两 膝 关节 和 两 躁 关 节 的 角度 是 负 的 。 力矩 被 测量 
为 : 末端 连 杆 的 逆 时 针 方 向 为 正 


图 33.17 显示 了 一 个 75kg 的 人 在 平坦 地 面 以 
1. 3m/s 行走 时 的 临床 步 态 分 析 的 中 关节 和 角 数 据 。 尽 
管 图 33. 17 显示 了 行走 时 的 小 范围 的 运动 ( -20° ~ 
+15°) ， 但 是 其 他 运动 需要 较 大 范围 的 运动 。 正 常人 
中 关节 可 以 在 -38。~ +35° 范 围 内 届 伸 自如 。 为 了 补 
偿 外 骨骼 足 部 所 缺少 的 一 些 较 小 的 自由 度 ， 外 骨骼 踢 - l m i 
关节 的 最 大 活动 范围 选 为 上 45"。 所 有 图 中 的 TO 35] 时 间 /s 
表示 脚趾 离 地 ，HS 均 表 示 脚 跟 触 地 。 图 33. 18 显示 
了 调整 后 的 临床 步 态 分 析 的 趴 关节 届 伸 力矩 的 数据 。 图 33. 18 ”三 组 调整 后 的 躁 关节 弯曲 力矩 和 伸展 力矩 
的 CGA 数据 (峰值 负 力 矩 (伸展 ) 很 大 ， 约 120Nm， 

发 生 于 站 姿 未 ， 中 关节 力矩 在 摆 腿 过 程 中 很 小 ) 


XT goes P075 gni oe TT RS DL BR 713 
进行 分 析 。 所 求 膝 部 力矩 具有 正 的 分 量 和 负 的 分 量 ， 
说 明 这 里 需要 双向 致 动 器 。 力 抢 的 峰值 在 站 立 状 态 初 
始 时 增 大 (24 60N +m); 因此 非 对 称 致 动 器 应 当 偏 
置 以 提供 更 大 的 扩展 力矩 。 髋 部 力矩 相对 来 讲 是 对 称 
的 ( -80 ~ +60N-m); 因此 ， 需 要 一 个 双向 髋 关节 
致 动 器 。 在 通关 节 支 持 腿 部 负载 的 站 立 初始 阶段 ， 需 
要 负 向 的 扩展 力矩 。 

在 站 立 末 端 阶段 和 髋 关节 驱动 腿 部 开始 前 摆 时 ， 

时 间 /s 八 关 节 力 和 矩 是 正 的 。 在 摆动 过 程 末 、 通 关节 在 脚后跟 
ease ics us 
图 33.17 EANA RJA Sm h A ERARA JE 25 500 0 50d T 
的 CGA 数据 (最 小 的 伸展 角度 约 为 -20"， 发 生 在 脚 xui nn ever A 
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AEW 动 范围 ， 以 适应 BLEEX 中 没有 建 模 的 人 足 部 的 较 小 


自由 度 的 要 求 。 
表 33.1 BLEEX 各 关节 的 角度 范围 


- 人 行走 最 大 值 |BLEEX 最 大 值 | 男性 士兵 
运动 =) 
we) /A(°) 平均 /(°) 
趴 部 弯曲 14.1 45 35 
中 部 伸展 20.6 45 38 
中 部 外 展 无 数据 20 23 
中 部 内 收 无 数据 20 24 
° in m uid i Bep ERS 73.5 121 159 
图 33. 19 三 组 调整 后 的 躁 关节 弯曲 瞬时 机 械 能 和 伸 X 32.2 121 125 
展 瞬 时 机 械 能 的 CGA 数据 (中 关节 的 平均 功率 为 正 ， 7 
rien JE 22.5 10 无 数据 
表明 躁 关节 做 正 功 ， 且 需要 传动 ) ii ü 
[XVI 7.9 16 53 
源 大 小 。 资 料 显示 常人 以 3mile/hO 的 平均 速度 行走 
时 大 约 需 消耗 0.25 马力 (185W)。 这 个 代表 速度 与 。 "Ua | 64 s: j 
力矩 平均 乘积 的 数字 是 行走 时 腿 部 消耗 的 纯 机 械 能 的 外 部 总 旋转 13.2 35 73 
反映 。 由 于 假设 了 在 几何 结构 和 重量 上 ， 外 骨骼 与 人 — 
EL 4B Jh HM Oe ee ERES en HSL 人 内 部 总 旋转 1.6 35 66 
体 是 相似 的 ， 因 此 关键 设计 目标 之 一 就 是 设计 一 个 电 
源 单 元 和 致 动 系统 ， 使 其 能 够 向 外 骨骼 的 关节 处 输出 
| 设计 一 个 三 自由 度 的 外 骨骼 通关 节 以 使 全 部 三 


0. 25 马力 。 

BLEEX 的 运动 学 特性 与 人 腿 的 运动 学 特性 很 接 
近 ， 因 此 BLEEX 的 关节 运动 范围 是 由 对 人 体 关 节 的 
运动 范围 的 观测 所 决定 的 。 最 起 码 ，BLEEX 的 关节 
运动 范围 应 当 与 人 行走 时 的 关节 运动 范围 相当 ( 见 
表 33.1 中 的 第 一 列 数据 ) 。 对 每 个 自由 度 ， 表 33. 1 
中 的 第 二 列 列 出 了 BLEEX 的 关节 运动 范围 ， 一 般 大 
于 人 行走 时 的 关节 运动 范围 ， 小 于 人 关节 运动 范围 的 
最 大 值 。 

操作 性 最 强 的 外 骨骼 系统 应 当 具 有 理想 的 关节 运 
动 范围 ， 这 个 运动 范围 比 人 关节 运动 范围 的 最 大 值 稍 
小 。 然 而 ，BLEEX 使 用 直线 致 动 器 ， 因 此 ， 一 些 关 
节 的 运动 范围 就 减 小 到 了 防止 致 动 器 的 运动 轴线 经 过 
关节 中 心 的 程度 。 如 果 没 有 这 样 的 话 ， 那 么 关节 可 能 
会 达到 一 个 致 动 器 无 法 产生 关于 关节 中 心 的 力矩 的 状 
态 。 此 外 ， 所 有 关节 的 运动 范围 在 样机 测试 时 都 经 过 
了 测试 和 修正 。 例 如 ， 样 机 测试 决定 了 BLEEX 的 中 
部 的 流畅 性 /扩展 性 运动 范围 需要 大 于 人 的 中 部 的 运 


z 
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个 转动 轴 经 过 人 的 球状 关节 是 很 自然 的 。 然 而 ， 通 
过 设计 一 些 样机 和 实验 ,证实 了 这 些 设计 的 运动 范 
围 有 局 限 并 在 一 些 髋 关节 的 姿态 处 产生 了 奇异 点 。 
因此 旋转 关节 就 发 生 了 移动 ， 使 其 无 法 与 通关 节 对 
齐 。 起 初 ， 旋 转 关节 被 直接 置 于 每 条 外 骨骼 腿 之 上 
(图 33.20 中 标 有 “可 选择 旋转 ”)。 这 样 做 在 轻 量 
塑料 样机 上 很 有 效 , 但 是 在 全 尺寸 样机 时 却 产 生 了 
问题 ， 这 主要 是 因为 躯干 的 质量 过 大 以 及 负载 产生 
的 一 个 大 的 关于 非 驱 动 旋转 关节 的 力矩 。 因 此 ， 现 
有 两 腿 的 髋 部 旋转 关节 被 选择 为 一 个 在 人 体 后 面 和 
AKTE FAUSSE: (图 33.20 中 标 有 “ 现 有 旋 
转 ”) 。 现 有 的 旋转 关节 十 分 典型 地 通过 弹簧 钢 片 以 
弹簧 负载 连 向 图 示 位 置 。 
正如 人 的 中 部 ，BLEEX 的 趴 部 具有 三 个 自由 度 。 
伸缩 / 开 合 轴 与 人 的 踩 关节 完全 一 致 。 为 了 简化 设计 ， 
BLEEX 的 踩 关 节 的 开 合 与 旋转 轴 不 经 过 人 的 腿 部 ， 
由 此 形成 了 人 足 部 外 的 一 个 平面 (ILE 33.21), 
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图 33. 20 SHRED Nis A BUE CRA). 只 
Ae Hi A Bt ARR (调整 托 架 可 以 改变 位 
置 以 便于 适应 各 种 体型 的 操作 员 ) 


弹性 脚趾 


DO ...- 


弯曲 /伸展 …… 


图 33.21 外 骨骼 躁 部 的 运动 自由 度 (只 有 弯曲 轴 和 伸 
展 轴 通 过 人 的 躁 关节 ， 外 展 或 内 收 轴 和 旋转 轴 没 有 动 
A, 但 具备 适当 的 阻抗 ) 


为 了 承担 人 体 趴 部 的 负载 ，BLEEX 的 躁 部 的 开 
合 关节 由 弹簧 连 向 垂直 方向 ， 但 是 旋转 关节 是 完全 自 
由 的 。 再 者 ， 外 骨骼 足 部 的 前 侧 位 于 操作 者 的 脚趾 之 
下 ， 它 是 柔性 的 以 使 外 骨骼 足 部 可 以 与 人 脚 贴 合 。 由 
于 人 和 外 骨骼 的 腿 部 运动 学 并 不 完全 相同 〈 仅 仅 是 
相似 ) ， 人 和 外 骨骼 只 是 刚性 地 通过 未 端 连接 在 一 起 
( 足 部 和 躯干 ) 。 

BLEEX 的 足 部 是 一 个 极其 重要 的 部 件 ， 因 为 它 
具有 如 下 的 多 种 功能 : 

1) 测量 足 部 压力 中 心 的 位 置 ， 从 而 识别 足 部 与 
地 面 的 接触 情况 。 该 信息 对 BLEEX 的 控制 必 不 
可 少 。 

2) 测量 人 的 载荷 分 布 (每 条 腿 上 分 担 的 人 体重 
量 ) ， 该 信息 也 用 于 BLEEX 的 控制 。 

3) 将 BLEEX 的 重量 传递 给 地 面 ， 因 此 它 必须 具 
有 结构 完整 性 ， 并 在 有 周期 性 外 力 的 情况 下 显示 出 长 


寿命 。 


4) 它 是 人 体 与 外 骨骼 的 两 个 刚性 连接 处 之 一 。 
因此 ， 对 于 操作 者 ， 它 必须 是 舒适 的 。 

如 图 33. 22 所 示 ， 足 部 的 主要 结构 具有 一 个 硬 
度 高 的 后 跟 ， 它 已 将 负载 传递 至 地 面 并 为 脚趾 提供 
舒适 自如 的 环境 。 操 作者 的 埋 通 过 快速 释放 的 捆绑 
物 刚 性 地 连接 于 外 骨骼 足 部 的 顶部 。 开 关 治 着 足 底 
探测 足 部 的 哪 部 分 与 地 面 接触 。 出 于 坚固 性 的 考虑 ， 
这 些 开关 被 租 入 了 订 做 的 橡胶 底 中 。 同 样 在 图 
33. 22 中 可 以 看 到 的 是 负载 分 布 传感器 ， 它 是 一 条 
橡胶 压力 管 ， 其 中 填充 了 液态 的 油 并 夹 在 人 脚 与 外 
骨骼 足 部 的 主 结构 之 间 。 传 递 至 压力 管 的 仅 有 人 体 
的 重量 (不 是 外 骨骼 的 )， 并 由 传 感 带 测量 。 控 制 
算法 通过 传感器 来 探测 人 体 分 别 向 其 左 脚 和 右 脚 分 
配 了 多 少 重 量 。 


刚性 后 跟 
加 速度 计 


足 部 开关 


Æl 33.22 BLEEX 的 足 部 设计 (分 解 图 ) 


BLEEX 的 小 腿 和 大 腿 的 功能 是 结构 性 支撑 以 
及 将 弯曲 /伸缩 关节 连接 在 一 起 ( 见 图 33.23 和 
图 33. 24)。 


图 33.23 BLEEX 的 小 腿 设 计 
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图 33.24 BLEEX 的 大 腿 设 计 


小 腿 和 大 腿 都 是 为 调整 以 适应 90% 的 人 群 而 设 
计 的 ; 它们 由 两 片 相互 滑动 已 能 够 锁定 在 所 需 长 度 的 
结构 组 成 。 为 了 使 液 路 流量 最 小 ， 设 计 了 歧 管 以 使 流 
体 在 阀门 、 致 动 器 、 供 液 源 和 回 线 之 间 流 动 。 这 些 歧 
管 直 接 加 载 于 液压 缸 上 ， 这 样 可 以 减少 阀门 和 致 动 器 
之 间 的 液 路 距离 ， 使 致 动 器 的 性 能 尽 可 能 最 高 。 躁 部 
的 致 动 腾 、 上 导管 和 阀门 装置 于 小 腿 ， 而 膝 部 艇 部 的 
致 动 器 、 歧 管 和 阀门 装置 于 大 腿 。 一 个 歧 管 加 载 于 膝 
部 致 动 器 ， 为 膝 部 和 人 散 部 致 动 器 的 流体 提供 导向 。 如 
图 33.25 所 示 ，BLEEX 艇 干 与 髋 部 结构 相连 接 (UL 
图 33. 20)。 

电源 、 控 制 计算 机 和 负载 加 载 于 躯干 的 两 
A479) 。 加 载 于 躯干 的 倾角 计 为 控制 算法 提供 绝 
对 角度 参考 值 。 自 定义 的 挽 具 ( 见 图 33.26) 加 载 于 
躯干 前 方 ， 用 于 将 外 骨骼 固定 于 操作 者 的 身体 。 除 了 
足 部 ， 挽 具 是 使 用 者 与 外 骨骼 刚性 相连 的 另外 一 处 连 
接点 。 图 33.25 thane SAP ABA A ET AY Be 
fat HOT) AM 


SBE ABIDE IB 
SEER) RIS 


SIOM 


图 33.25 BLEEX 的 躯干 设计 (后 视图 ) 


z- 
前 视图 


图 33.26 图 33. 10 中 的 操作 员 背 心 , 采用 了 可 将 
BLEEX 操作 员 作用 力 均 匀 分 散 于 操作 员 上 半身 的 设计 


33.9 ”现场 就 绪 的 外 骨骼 系统 


本 节 摘 述 两 种 由 伯克利 生物 工程 小 组 的 成 员 与 加 
州 大 学 的 研究 人 员 合 作 开发 的 现场 就 绪 的 外 骨骼 


33.9.1 ExoHiker 外 骨骼 


ExoHiker 外 骨骼 系统 ( 见 图 33.27) 是 伯克利 生 
物 工程 小 组 与 加 州 大 学 的 研究 团队 开发 的 第 一 套 外 骨 
BAS; 作为 一 种 负重 装置 ， 它 也 是 世界 上 第 一 套 能 


够 通过 严格 检验 的 外 骨骼 系统 。 


图 33. 27 ExoHiker 现场 就 绪 外 骨骼 ， 


适 于 缓坡 ， 能 够 搬运 90kg 的 重 


物 


它 用 于 在 海拔 变化 小 的 长 途 任务 中 搬运 沉重 的 


背包 。 


它 的 重量 仅 为 14.$kg， 其 中 包括 电源 和 机 载 计 


算 机 。 它 的 负载 能 力 为 90kg， 穿 戴 者 | 


比 时 几乎 感受 
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不 到 重量 。 装 置 的 噪声 微小 、 不 易 察 觉 。 量 产 版 的 该 
型 外 骨骼 系统 能 够 使 穿戴 者 在 背负 68kg 的 背 

况 下 ， 以 4.0km/h 的 平均 速度 行走 68km， 而 提供 动 
力 的 锂电 池 重 量 仅 为 0. 5kg。 加 装 小 型 太阳 能 电池 板 
后 ,续航 时 间 可 以 不 受 限制 。ExoHiker 的 尺寸 可 以 依 
据 穿戴 者 的 身高 进行 调节 ， 其 范围 是 约 1.65m 到 
1. 91m。 所 有 的 控制 功能 都 能 由 使 用 者 通过 装 有 图 形 
用 户 界面 系统 的 简易 手持 液晶 显示 控制 器 来 控制 。 该 
外 骨骼 系统 已 由 特种 作战 研究 支持 小 组 在 落 基山 的 山 
路 上 进行 了 测试 ， 也 在 Natick 士兵 系统 中 心 的 实验 室 
中 作 了 测试 。 


33. 9.2 ExoClimber 外 骨骼 


这 种 外 骨骼 系统 (UL 33.28) 的 设计 能 够 在 满 
足 与 ExoHiker 相同 的 长 期 负重 能 力 要 求 的 同时 ， 满 
足 迅速 上 台阶 或 斜坡 的 要 求 。 


图 33. 28 ExocClimberTi 现 场 就 绪 外 骨骼 ， 
适 于 快速 疏 升 台阶 和 陡坡 


它 的 重量 为 23kg， 包 含 电源 和 机 载 计算 机 ; 其 
负载 能 力 为 90kg。 这 种 外 骨骼 系统 的 噪声 音量 与 打 
印 机 的 噪声 音量 相仿 。 它 的 电池 续航 能 力 要 求 与 
ExoHiker 4H], BR SSM BERL, EEES, Exo- 
Climber 能 够 在 负重 68kg HT 55/8 300m， 电 池 重 量 为 
0. 5kg。 该 外 骨骼 系统 已 由 特种 作战 研究 支持 小 组 在 
落 基 山 的 山路 上 进行 了 测试 ， 也 在 Natick 士兵 系统 中 
心 的 实验 室 中 作 了 测试 。 检 测 内 容 包 括 在 表面 有 积 雪 
覆盖 的 斜坡 上 穿 防滑 鞋 和 不 穿 防滑 鞋 时 的 攀 仆 。 检 测 


结果 相当 出 色 ， 而 且 在 一 次 实验 中 穿戴 者 使 用 Exo- 
Climber 背负 45kg 背包 的 行走 距离 提高 了 900% 。 

伯克利 生物 工程 小 组 新 近 开发 的 外 骨骼 系统 具有 
两 个 新 的 独立 特征 : 

1) 它 提高 了 穿戴 者 的 负重 能 力 (68kg 提高 到 
90kg) 。 

2) 降低 了 穿戴 者 的 体力 消耗 。 

在 从 2006 年 年 未 至 2007 年 年 初 的 一 些 先期 测试 
中 ， 当 使 用 者 以 3. 2km/h 的 速度 无 负重 行进 时 ， 对 
氧气 的 消耗 量 降低 了 5% ~12% 。 当 使 用 者 背负 重 物 
时 ， 其 效果 更 为 明显 。 当 使 用 这 种 外 骨骼 系统 时 ， 穿 
戴 者 以 3. 2km/h 的 速度 背负 37kg 重 物 行进 时 的 氧 消 
m RMT A 15% 。 这 是 世界 上 首 套 宣称 可 降低 穿 
戴 者 氧 消耗 量 的 外 骨骼 系统 。 


结论 与 扩展 阅读 


外 骨骼 技术 尚 处 于 起 步 阶 段 。 尽 管 这 部 分 分 析 中 
的 外 骨骼 系统 基本 被 当做 机 器 人 系统 一 一 它们 穿戴 在 
人 体 上 、 用 来 搬运 重 物 ， 但 是 读者 需要 注意 的 是 : 医 
学 矫正 器 领域 也 提供 了 与 病人 相关 的 系统 知识 和 灵感 
财富 ， 这 些 系统 或 用 作 康 复 装 置 、 或 用 作 辅 助 装置 。 
关于 这 些 系 统 的 例子 ， 请 读者 们 参阅 与 气压 踩 部 康复 
矫正 器 有 关 的 文献 参考 [30.50，51]。 目 前 ， 限 制 
外 骨骼 技术 发 展 的 最 大 问题 是 电源 和 致 动 器 。 如 果 没 
有 可 行 的 电源 ， 外 骨骼 系统 将 仅 限于 室内 应 用 。 
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移动 式 和 分 布 式 机 器 人 技术 


20 世纪 60 年 代 后 期 美国 斯 坦 福 研 究 所 (SRI) 
开始 Shakey 项 目标 志 着 移动 机 需 人 成 为 一 个 研究 领 
域 。1969 4E, N. J. Nilsson 在 人 工 智能 国际 联合 会 议 
(ICAL) 上 所 作 的 研讨 论文 “移动 机 器 人 : ATE 
能 技术 的 一 个 应 用 ”中 已 经 提出 了 感知 、 建 图 、 运 
动 规划 以 及 控制 架构 的 想法 。 那 些 问 题 的 确 就 是 接 下 
来 几 十 年 内 移动 机 器 人 研究 的 核心 。20 世纪 80 年 代 
移动 机 器 人 项 目的 研究 莲 勃 发 展 ， 不 久 移动 机 器 人 就 
需要 与 现实 的 物理 世界 相 协 调 ， 问 题 产生 出 来 : 所 孕 
育 出 的 新 研究 方向 ， 实 际 上 正在 偏离 机 右 人 只 是 人 工 
智能 技术 应 用 的 最 初 概念 。 这 部 分 介绍 的 所 有 问题 ， 
除了 机 械 设计 本 身 之 外 ， 是 为 了 建立 和 控制 移动 机 器 
人 所 需要 知道 的 。 


此 背景 下 ， 非 完整 的 运动 学 约束 成 为 一 个 主要 的 难 
题 ， 微 分 几何 作为 一 个 主要 的 工具 来 实现 经 典 运动 规 
划 器 计算 出 来 的 运动 。 这 里 介绍 的 与 经 典 运动 规划 的 
另 一 个 不 同 之 处 在 于 : 规划 在 未 知 环境 中 的 未 知 或 移 
动 的 障碍 物 ， 这 使 得 使 用 基于 传感器 的 运动 开发 
方法 。 

移动 机 器 人 的 导航 需要 建立 周围 环境 的 地 图 。 因 
此 第 36 章 介绍 了 第 一 个 问题 : 什么 样 的 表示 是 最 充 
分 的 ， 举 例 来 说 ， 在 不 平坦 地 形 上 ， 观 念 中 的 障碍 物 
在 室内 与 室外 相 比 有 什么 不 同 的 意义 ? 为 一 个 问题 
是 : 应 如 何 处 理 传 感 的 不 确定 性 ? 进一步 说 ， 当 移动 
机 器 人 进入 某 个 工作 环境 时 ， 它 们 需要 增 量 式 地 建立 
它们 的 环境 地 图 。 因 此 ， 从 不 同位 置 建立 的 局 部 表象 


传 感 是 第 3 篇 的 主题 ， 但 是 使 用 传 感 来 进行 环境 
建 图 、 机 器 人 定位 和 移动 机 器 人 导航 却 是 本 部 分 中 第 
36 章 和 第 37 章 的 内 容 ， 也 与 估计 理论 有 非常 近 的 联 
系 (第 1 篇 的 第 4 章 ) 。 在 基础 部 分 (第 1 篇 ) 介绍 
的 几 个 问题 也 在 这 部 分 作 了 重复 介绍 ， 并 放 到 了 移动 
机 器 人 具体 化 的 背景 资料 中 ， 如 运动 控制 (第 1 篇 的 
第 6 章 ， 本 篇 的 第 34 章 )。 运 动 规划 在 第 1 篇 的 第 5 
章 介 绍 过 ， 运 动 规划 和 避 障 的 具体 问题 也 是 第 35 章 
的 内 容 。 移 动机 器 人 是 一 个 集成 传 感 、 决 策 和 执行 的 
系统 。 因 此 ， 在 机 器 人 学 中 ， 通 过 移动 机 器 人 过 多 地 
开发 控制 架构 问题 ， 经 常 引 起 争论 。 第 38 章 ， 重 点 
是 基于 行为 的 系统 ， 应 该 适当 阅读 这 章 ， 同 时 应 该 对 
第 8 章 (第 1 篇 ) 的 机 器 人 系统 架构 和 编程 、 第 9 章 
(第 1 篇 ) 的 人 工 智能 的 推理 和 对 机 器 人 学 的 学 习 方 
法 牢记 于 心 。 

当 几 个 移动 机 器 人 碰撞 到 一 起 会 发 生 什 么 事 呢 ? 
RAT ARBRE ENN? 又 如 何 能 控制 ? 这 些 问 题 很 
早 就 出 现 了 。 答 案 在 第 39、40 和 41 章 。 

随 着 移动 机 器 人 的 发 展 ， 当 需要 实现 光滑 和 有 效 
的 运动 并 跟踪 确定 的 轨迹 时 ， 控 制 问题 成 为 主要 关心 
的 问题 。 此 外 ， 轮 式 机 器 人 移动 结构 的 设计 经 常 与 汽 
车 的 移动 机 构 相 似 ， 即 非 完 整 约束 。 对 于 机 械 辟 研究 
是 必 不 可 少 的 运动 学 和 控制 也 相应 地 进入 到 移动 机 器 
人 的 领域 。 主 要 使 用 反馈 控制 和 线性 控制 理论 的 转向 
控制 技术 在 第 34 章 进行 介绍 。 
第 35 章 从 移动 机 器 人 的 角度 介绍 运动 规划 。 在 


需要 融合 到 一 起 来 组 建 一 个 统一 地 图 。 这 就 要 求 机 器 
人 知道 那些 位 置 ， 这 些 位 置 仅 有 相对 于 环境 地 图 自身 
的 定义 。 因 此 ， 定 位 与 建 图 必须 同时 实现 ， 第 37 章 
概述 了 解决 这 个 SLAM (同时 定位 与 建 图 ) 问题 的 
技术 。 

20 世纪 80 年 代 中 期 是 移动 机 器 人 发 展 非常 火热 
的 一 个 时 期 。 三 个 主题 被 首次 提出 : SLAM、 非 完整 
约束 和 控制 架构 。 或 许 此 领域 中 最 令 人 兴奋 的 争论 之 
一 是 由 Rodney Brooks 提出 的 包容 架构 ， 该 架构 通过 
去 除 架 构 中 的 审议 组 件 ， 成 为 基于 行为 机 器 人 的 范 
例 。 第 38 章 讨 论 了 那些 架构 概念 。 
本 篇 关于 分 布 式 机 器 人 技术 包含 了 3 章 。 多 个 移 
动机 器 人 之 间 进 行 交 互 来 实现 一 个 共同 的 使 命 或 进行 
协调 ， 通 过 直接 或 间接 的 通信 ， 或 者 甚至 完全 没有 沟 
通 ， 机 器 人 系统 由 几 个 机 器 人 组 成 或 者 由 一 大 群 机 器 
人 组 成 ， 它 们 带 有 新 兴 行 为 ， 所 依赖 的 算法 在 第 40 
章 介 绍 。 在 那 一 章 ， 每 个 机 器 人 都 有 自己 的 容量 和 个 
体 行为 。 我 们 可 以 由 其 他 的 机 器 人 设计 机 器 人 吗 ? 机 
器 人 可 以 改装 自己 的 身体 吗 ? 机 器 人 可 以 自我 复制 
吗 ? 第 39 章 概 述 了 模块 化 机 器 人 人， 例如， 由 可 互 换 
零件 建立 的 机 器 人 ， 根 据 任务 、 运 动 或 形势 ， 它 们 可 
以 改装 他 们 自己 。 

最 后 ， 随 着 微型 化 和 无 线 通信 的 发 展 ， 分 布 式 机 
器 人 自身 的 概念 已 有 另 一 种 及 寸 。 机 器 人 可 以 分 散在 
任何 地 方 ， 变 得 无 孔 不 人 。 这 些 新 问题 作为 这 部 分 的 


总 结 ， 在 第 41 章 中 介绍 。 
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本 章 是 第 17 草 的 延续 ， 主 要 研究 基本 轮 式 运 
动机 带 人 结构 的 分 类 与 建 模 。 同 时 ， 本 章 也 是 对 第 
35 章 的 补充 ， 该 章 研 究 的 是 轮 式 运动 机 带 人 的 运 
动 规划 方法 。 这 些 方法 的 一 个 典型 结果 ， 就 是 针对 
给 定 的 运动 机 器 人 ， 提 出 可 行 的 参考 状态 轨迹 。 随 
之 而 来 的 问题 是 如 何 使 得 实体 机 器 人 ， 能 够 通过 控 
制 安装 在 其 上 的 致 动 器 ,来 实现 跟踪 这 一 参考 轨 
迹 。 本 章 的 目标 就 是 在 基于 简单 有 效 的 控制 策略 前 
提 下 ， 描 述 解决 这 一 问题 的 基本 要 素 。 第 一 种 方法 
是 应 用 开 环 驱动 控制 律 ， 如 第 35 章 所 推导 的 那样 。 
然而 ,众所周知 这 类 控制 对 于 模型 误差 的 鲁 棒 性 
差 ， 不 能 保证 机 器 人 按 预 先 设计 的 轨迹 运动 。 这 就 
是 为 什么 我 们 这 里 所 采用 的 方法 都 是 基于 反馈 控制 
的 原因 。 它 们 能 够 实现 的 前 提 是 假设 控制 环 路 中 的 
变量 可 以 测量 (机 器 人 相对 于 固定 坐标 系 或 小 车 
应 遵循 的 路 径 的 典型 位 置 和 方向 )。 在 这 一 章 中 ， 
我 们 将 假定 这 些 测量 是 时 间 上 连续 的 ， 并 且 它 们 是 
没有 噪声 污染 的 。 像 通常 方法 那样 ， 重 棒 性 分 析 不 
会 进行 详细 讨论 。 甚 中 一 个 原因 是 很 大 一 部 分 的 描 
述 方法 是 基于 线性 控制 理论 的 ， 且 超出 了 规定 篇 幅 
的 限定 。 反 馈 控制 律 通常 继承 了 线性 系统 稳定 性 所 
附带 的 较 强 的 鲁 棒 性 。 
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34.1 背景 


bl 


轮 式 移动 机 器 人 的 控制 已 经 是 并 且 仍旧 是 许多 研 
究 工 作 的 研究 主题 。 特 别 地 ， 与 这 些 系统 相关 联 的 非 


这 种 结果 也 可 以 通过 使 用 带 补 充 性 的 、 最 终 更 
精细 的 自动 控制 技术 获得 。 
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章 中 所 提出 的 分 类 模型 中 的 类 型 (2, 0) 和 类 型 
G, 1)。 事 实 上 ， 大 部 分 结果 可 以 扩展 或 改造 用 于 
其 他 类 型 的 移动 机 器 人 ， 特 别 是 含有 拖车 的 系统 。 我 
们 会 指出 在 什么 样 的 情形 下 这 种 扩展 是 很 直接 的 。 所 
有 解释 各 种 控制 问题 和 解决 办 法 的 仿真 结果 都 是 基于 


完整 性 约束 推动 了 强 非 线性 控制 技术 的 发 展 。 这 些 方 
法 将 在 本 章 中 呈现 ， 但 对 它们 的 阐述 进行 了 一 定 的 限 
制 ， 以 便 优先 介绍 一 些 更 基础 的 理论 。 不 论 从 理论 方 
面 ， 还 是 从 实际 应 用 方面 ， 这 些 理论 的 基础 已 被 很 好 
的 建立 。 

为 了 简单 起 见 ， 控 制 方法 的 发 展 主要 是 针对 独 轮 
车 型 和 轿车 型 的 移动 机 器 人 ， 这 分 别 对 应 于 在 第 17 


小 车 型 机 器 人 得 出 的 ， 这 种 机 器 人 的 运动 学 比 独 轮 车 
型 的 要 更 复杂 一 些 。 

如 图 34. 1 所 示 : 

1) 一 个 独 轮 车 型 机 器 人 包含 两 个 可 独立 驱动 
的 轮子 ,它们 被 安装 在 同一 个 轴 上 ， 轴 的 方向 与 
机 器 人 的 底座 刚性 相关 ， 另 外 还 有 一 个 或 多 个 被 
动 转 向 〈 或 悬挂 ) 的 轮子 ， 它 们 不 受 控 制 ， 只 起 
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支撑 作用 。 

2) 一 个 〈 后 轮 驱 动 ) 轿车 型 移动 机 器 人 由 一 个 
机 箱 后 部 的 动力 轮轴 和 一 个 (或 一 对 ) 可 转向 的 前 
轮 组 成 。 


LL. 


图 34. 1 独 轮 车 型 (A) 和 轿车 型 CA) 移动 机 器 人 


不 仅 如 此 ， 如 图 34. 2 所 示 ， 轿 车 型 移动 机 器 人 
(至 少 在 运动 学 上 ) 可 以 视 为 独 轮 车 式 移动 机 器 人 与 
一 个 拖车 的 连接 。 


LR DS 


图 34.2 轿车 / 带 拖车 的 独 轮 车 的 模拟 


我 们 将 在 本 章 研 究 三 类 一 般 性 的 控制 问题 ， 所 述 
如 下 。 


34.1.1 路 径 跟 踪 


给 定 平面 上 的 一 条 曲线 C， 机 器 人 底座 的 纵向 
速度 〈 非 零 ) v。， 选 定 底座 上 的 一 点 P， 目 的 是 使 
机 器 人 在 以 速度 wm 移动 时 ， 点 P 可 以 沿 着 曲线 C 运 
动 。 因 此 ， 必 须 镇 定 到 零点 的 变量 就 是 点 已 和 曲线 
之 间 的 距离 (也 就 是 说 ， 点 己 与 距离 曲线 C 上 最 近 
W M 之 间 的 距离 ) 。 这 个 类 型 的 问题 通常 对 应 于 
车 辆 在 道路 上 行驶 时 ， 试 图 保持 汽车 底座 和 道路 一 
侧 之 间 的 距离 恒定 。 自 动 围墙 跟踪 是 男 一 个 可 能 的 
应 用 。 


34.1.2 轨迹 的 镇 定 


这 类 问题 与 上 一 问题 的 不 同 在 于 ， 小 车 的 纵向 速 
度 不 再 是 预先 设 定好 的 ， 因 为 人 们 和 旨 在 监控 其 沿 曲线 
C 所 走 的 距离 。 这 一 目标 通常 假设 几何 曲线 C 是 由 一 
个 时 间 进 度 表 所 描述 的 ， 也 就 是 说 ， 它 可 以 由 时 间 变 
E 1 进行 参数 化 。 这 可 以 归结 为 在 参考 坐标 系 FP, rh 
定义 一 条 轨迹 1 (x, (0), y(t) )。 于 是 ,目标 变 为 


把 位 置 误差 向 量 (a(t) -x,(1), y(t) -y(t)) HUE 
到 零点 ， 其 中 (x(1) ,y(t)) 为 点 P 于 1 时 刻 在 参考 
AP, 中 的 坐标 。 这 个 问题 也 可 以 表述 为 控制 一 个 车 
辆 以 跟踪 男 一 个 参考 车 辆 的 轨迹 ， 而 参考 车 辆 的 轨迹 
由 上 H(t), y,0)). 给 出 。 值 得 注意 的 是 ， 能 够 
实现 精确 跟踪 的 前 提 是 参考 轨迹 对 于 物理 车 辆 是 可 行 
的 。 当 然 ， 对 于 独 轮 车 可 行 的 轨迹 不 必要 对 轿车 是 可 
行 的 。 此 外 ， 除 了 监测 机 器 人 的 位 置 (x(t), y(0)), 
人 们 还 希望 控制 底座 的 方向 6(:) ， 使 之 与 相关 参考 
车 辆 之 间 的 方向 保持 一 个 理想 的 参考 值 90.(1) 。 对 于 
一 个 非 完 整 约束 的 独 轮 车 型 机 器 人 ， 如 果 它 是 由 具 
有 物理 机 器 人 相同 运动 学 限制 的 参考 车 辆 产生 的 ， 
参考 轨迹 (x,(1) ,，y,(t) ，9,(1)) 是 可 行 的 。 例 如 ， 
大 多 数 由 全 向 运动 车 辆 (全 问 运 动车 辆 可 参考 第 17 
章 ) 所 产生 的 轨迹 对 于 非 完 整 约束 的 移动 机 器 人 是 
不 可 行 的 。 然 而 ， 不 可 行 性 并 不 意味 着 参考 轨迹 就 
不 可 以 用 一 种 近似 方式 ， 也 就 是 一 种 存在 小 误差 
(SEIF) 的 方式 ,来 进行 跟踪 。 这 表明 ， 相 对 
于 渐 近 镇 定性 ， 即 让 跟踪 误差 收敛 到 零 ， 引 入 实际 
镇 定 概念 是 合理 的 。 在 本 章 的 最 后 一 部 分 ， 针 对 不 
可 行 轨 迹 ， 我 们 将 致力 于 讨论 当前 和 预期 的 实际 镇 
定 控制 方法 。 


34.1.3 固定 位 姿 的 镇 定 


用 F, 表示 一 个 依附 于 机 器 人 底座 上 的 坐标 系 。 
在 这 一 章 中 ， 我 们 称 一 个 机 器 人 的 位 姿 (或 状态 ) 
为 机 器 人 底座 上 的 一 点 PP 的 位 置 ， 以 及 F 相对 于 运 
动 平面 内 的 一 个 固定 坐标 系 FS 之 间 的 方向 角 0(1)。 
对 于 最 后 这 类 问题 ,目标 是 使 位 姿 向 量 &(1) = 
(x(t), y(t), 000) 镇 定 到 零点 ， 其 中 (x(t), 
y(t)) 表示 在 坐标 系 中 点 的 位 置 。 尽 管 固定 的 
参考 位 姿 显然 是 可 行 轨迹 的 一 种 特殊 情形 ， 但 这 一 问 
题 并 不 能 用 经 典 控制 方法 解决 。 

本 章 的 组 织 结构 如 下 。 第 34. 2 节 专 门 讨论 控制 
模型 的 选择 ， 以 及 与 路 径 跟 踪 控 制 问题 相关 的 建 模 方 
程 的 确定 。 第 34. 3 节 研 究 路 径 跟踪 和 轨迹 位 置 镇 定 
问题 ， 假 设 条 件 是 在 机 器 人 底座 上 选择 尸 点 的 位 置 。 
这 一 假设 暗示 该 点 的 运动 是 不 受 约束 的 。 它 大 大 简化 
了 所 考虑 问题 的 求解 。 然 而 ， 这 种 简化 的 问题 在 于 ， 
机 器 人 方向 角 的 稳定 性 并 不 能 总 被 保证 ， 特 别 是 当 某 
些 阶段 机 器 人 的 纵向 速度 的 符号 不 恒定 的 时 候 。 第 
34.4 节 殊 除了 这 种 对 于 P 点 选取 的 假设 ,并 重新 考 
虑 了 以 上 两 个 问题 ， 以 及 固定 位 姿 的 镇 定 问题 。 在 本 
小 节 的 最 后 ， 指 出 了 一 些 以 渐 近 镇 定性 为 目标 的 缺点 
和 局 限 性 。 这 些 问 题 可 以 通过 考虑 以 实际 镇 定性 为 目 
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PAN EET URE. XE VL FY Jot es P395 R BC BY) ff E , 
当前 存在 的 和 预期 发 展 的 控制 方法 的 一 些 基 本 要 素 将 
在 第 34.4.6 节 呈 现 。 最 后 ， 就 移动 机 器 人 反馈 挖角 
的 一 些 补充 问题 进行 了 简要 讨论 并 总 结 在 第 34. 5 节 ， 
同时 给 出 一 个 注释 参考 文献 列表 便于 轮 式 移 动机 器 人 
的 运动 控制 的 深入 阅读 。 


= 


34.2 ”控制 模型 


34. 2.1 运动 学 和 动力 学 

第 17 章 中 的 关系 式 (17.29) 给 出 了 为 轮 式 
移动 机 器 人 结构 动态 模型 的 一 般 方法 。 对 于 独 轮 
车 式 和 轿车 式 的 移动 机 器 人 的 特殊 情形 ， 给 出 公 
CF. 


H(q)u *F(q,u)u- I()T (34.1) 
式 中 ,g 表示 机 器 人 的 结构 向 量 ; u SALA DN 
自由 度 相 关 的 独立 速度 变量 组 成 的 向 量 ; H(q) 为 降 
阶 惯性 矩阵 (OHER q FAT Bi); F(q, u)u 是 科 氏 
Jj (地 球 自转 偏向 力 ) 和 车 轮 一 地 面 压力 所 综合 作 
用 下 的 合力 向 量 ; O 为 小 车 方向 轮 的 方向 角 ; 万 为 可 
逆 控 制 矩阵 (在 独 轮 车 型 的 情形 下 是 定常 矩阵 ); T 
为 独立 电动 机 转 矩 向 量 (其 维 数 等 于 全 驱动 情形 下 
自由 度 的 个 数 ， ee 取 值 为 2)。 
对 于 独 轮 车 型 车 辆 ， 结 构 向 量 是 由 底座 位 姿 向 量 专 的 
分 量 和 所 有 (车 辆 地 盘 上 的 ) prove 
成 的 。 对 于 轿车 型 车 辆 ， 结 构 向 量 是 由 < 的 分 量 和 方 
向 轮 的 方向 角 所 组 成 的 。 
为 了 完整 性 ， 这 一 动态 模型 必须 辅 之 以 如 下 形式 
的 运动 方程 (RRA (17. 30)) 
d -S(q)u 
由 此 式 我 们 可 以 提取 一 个 简化 的 运动 学 模 
xk (17.33)) 


(34.2) 
型 (关系 


z - B(z)u (34.3) 

式 中 ,在 独 轮 车 情形 下 ， 取 z=é&; 在 轿车 型 情形 下 
z-(£, 0), 

在 自动 控制 的 概念 中 ， 完 整 的 动力 学 模型 ( 式 

(34.1) 和 式 (34.2)) 可 以 组 成 一 个 控制 系统 ， 可 


LS X-fKX, T), RF, X=(q, u) 为 系统 的 状 
态 向 量 ; 7 为 控制 输入 向 量 。 运 动 学 模型 式 (34.2) 
和 式 (34.3) 也 可 以 看 成 以 gq Mz 为 状态 向 量 ，z 为 
控制 向 量 的 控制 系统 。 这 些 模 型 都 可 以 用 来 进行 控制 
设计 和 分 析 。 在 本 章 的 剩余 部 分 ， 我 们 选择 运动 学 模 
型 式 (34.3) 进行 处 理 。 通 过 模拟 机 械 手 臂 的 运动 


控制 ， 得 出 如 下 结论 ， 更 倾向 于 Tucson m 
模型 ， 而 不 是 力矩 控制 输入 的 模型 。 这 一 选择 的 主要 


1) 运动 学 模型 比 动力 学 模型 更 简单 。 特 别 地 ， 
不 需要 引入 大 量 的 矩阵 值 的 方程 ， 这 些 方程 的 精确 
确定 要 依赖 于 大 量 的 关于 小 车 及 其 驱动 器 参数 的 知 
识 〈 车 体 结构 的 几何 重 构 ， 质 量 和 质量 惯性 和 矩 ， 简 
化 传输 电动 机 所 产生 转 矩 的 参数 等 ) 。 对 于 许多 应 
用 来 说 ， 我 们 并 不 需要 精确 知道 所 有 这 些 量 的 具体 
数值 。 

2) 在 使 用 电动 机 驱动 的 机 器 人 中 ， 这 些 电 动 

经 常 被 供 以 低 水 平 的 速度 控制 环 路 ， 这 种 环 路 
ja 速度 作为 参考 输入 ， 并 且 稳 定 
电动 机 的 角速度 到 这 个 值 上 。 如 果 这 个 调节 环 路 
非常 有 效 ， 那 么 设 定 速度 值 和 实际 速度 值 之 间 的 
差 将 会 很 小 ， 即 使 是 在 设 定 速度 值 和 电动 机 的 负 
载 连续 变化 的 时 候 (至少 在 一 定 范围 内 )。 这 种 类 
型 的 鲁 棒 性 可 以 反 过 来 让 我 们 把 设 定 速度 值 看 做 
一 个 自由 控 制 变量 。 很 多 工业 机 械 手 臂 的 配套 控 
制 器 都 是 基于 这 一 原理 。 

3) 上 述 所 引出 的 伺服 环 路 的 作用 是 从 车 辆 的 动 
力学 中 解 看 出 运动 学 部 分 。 如 果 这 些 环 路 不 存在 ， 那 
么 可 以 设计 它们 ， 甚 至 可 以 利用 动力 学 方程 式 
(34.1) 中 所 涉及 项 的 信息 来 提高 它们 性 能 。 例 如 ， 
假设 将 由 驱动 器 所 产生 的 力矩 作为 控制 输入 ， 一 种 简 
单 的 方式 进行 处 理 (至 少 理论 上 )， 就 构成 了 应 用 所 
谓 的 计算 力矩 方法 。 基 本 想法 是 将 动力 学 方程 线性 
化 ， 即 通过 设 

T=TCG) "| H(q)o «F(q,u)u] 

EU E Y —4- 18 0 B fie e PEE BE IR Ba = 
w, EPEE w 是 和 加 速度 向 量 同性 ， 扮 演 新 的 控制 
输入 向 量 的 角色 。 最 后 这 个 方程 指出 ， 一 个 使 用 电动 
机 转 矩 控制 小 车 的 问题 可 以 退化 为 一 个 加 速度 控制 输 
和 的 问题 上 。 通 过 采用 运动 学 模型 来 得 出 一 个 速度 控 
制 解 来 推导 这 样 一 个 问题 的 控制 解 ， 通 常 并 不 困难 。 
例如 


w= -k(u-u'(z,t)) +% 


个 解 ， 其 中 >0 且 假 设 u* 是 可 微 的 运 


(2,1) BG)yu + (su) 


云 动 学 解 ， 


是 二 
进一步 
u-u'(z,t) *(u(0) -u* (z,0) )e™ 

一 个 解 。 
IPFE AREE SEULI se 其 运动 学 模型 式 
(34.3) 从 现在 开始 采用 如 下 形式 
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X -u,cos0 


(34. 4) 


y =u sin 


0 =u, 
WP, (x, y) 表示 两 个 驱动 轮轴 心 连 线 的 中 点 P. 
的 坐标 ; ff 0 表示 机 器 人 底座 的 方向 〈( 见 图 34.3)。 
在 这 个 方程 中 ,wu 表示 小 车 纵向 速度 的 大 小 ，w, 表示 
底座 转向 时 的 瞬时 转速 。 变 量 ww 和 与 其 各 自 相应 
驱动 轮 的 角速度 有 着 如 下 一 一 对 应 关系 


uy XO +) 


u, = aR CE - f) 
式 中 , r 为 车 轮 的 半径 ; R 为 两 个 驱动 轮 之 间 的 距离 ，; 
oh) 为 右 (AE) 后 轮 的 角速度 。 


图 34.3 结构 变量 


对 于 轿车 型 移动 机 器 人 ， 其 运动 学 模型 式 (34.3) 
从 现在 开始 采用 如 下 形式 


X = u cos0 


y =u sin 

koi (34.5) 

0 = Flan 

=u, 
RPF, ORREK; 工 为 前 后 轮轴 
之 间 的 距离 。 在 接 下 来 所 有 的 仿真 中 , LHi 
为 1.2m。 


34.2.2 Frénet 坐标 系 下 的 建 模 


本 小 节 的 目的 是 把 前 面 建立 的 运动 学 模型 推广 到 
以 Frénet 坐标 系 为 参考 坐标 系 的 情形 。 这 个 推广 将 在 
后 面 论 述 路 径 跟踪 问题 时 被 用 到 。 
让 我 们 考虑 一 条 运动 平面 上 的 曲线 C， 如 图 34.4 
fim, 我们 定义 三 个 如 下 所 述 的 参考 系 FK, Fn M 
F.。 其 中 F,- 10, i, j) 是 一 个 固定 参考 坐标 系 ; 
忆 = {Pay ins ja) 是 一 个 依附 于 移动 机 器 人 车 体 
上 的 参考 坐标 系 ， 其 坐标 原点 P. 位 于 机 器 人 两 个 后 
轮 的 轴线 中 心 ; 参考 坐标 系 = {P i, j.| 由 此 


线 C 的 曲线 横 坐 标 s 导出 ， 使 得 单位 向 量 i 是 曲线 C 
的 切线 方向 。 

考虑 机 器 人 底座 上 的 一 点 P, S (Ll, L) 表示 
P AH FE, 的 基 所 表示 的 坐标 。 为 了 确定 已 点 相对 于 
HAR C 的 运动 方程 ， 我们 引入 三 个 变量 s,d 和 0,， 
分 别 定义 如 下 : 

1) s 是 点 已. 的 曲线 横 坐 标 ， 而 点 已 是 点 P 到 曲 
线 C 的 正 交 投影 。 若 点 了 与 曲线 足够 接近 ， 则 点 已 
存在 且 唯 一 。 更 加 精确 的 说 ， 只 要 曲线 和 点 P 间 的 
距离 小 于 曲线 半径 的 下 界 。 我 们 假定 这 个 条 件 是 满 
足 的 。 


图 34.4 Frénet 坐标 系 下 的 表述 


2) d 是 在 参考 系 中 位 于 P 点 的 纵 坐 标 ;， 其 绝 
对 值 大 小 就 是 P 点 与 曲线 之 间 的 距离 。 

3) 6,20 - 0, 是 描述 机 器 人 底座 相对 于 F, 参考 
系 的 方向 角 。 

现在 我 们 来 确定 ;，d 和 6.。 由 定义 ， 曲 线 C 上 
P. 点 的 曲率 为 c(*) ， 即 c(*) =90./9s， 由 式 (34.4) 
可 得 


0. =u, -sc(s) (34. 6) 


Hi P.P=dj,, 根据 等 式 dOP/dt = 法 ， 首 先 可 
以 得 出 


90P OOP, .. 
= ~+dj 
at at s 


de(s)si, (34.7) 


=3(1 - de( s) )i, + dj, 
MA P,P = hi, thin, HF dOP,/di = uin, WF 


oa0P ”0OP， 
ot a 


luin 


Flu, 
=(u, -Lluj)i, * liu; jm 
=(u, - lu) ( cos0 i, + sin0, j,) + 

L,u,( — sinO,i, + cos0, j,) 
=[(u, ^ Lu) cos0, -l u,sin8, ji, + 

[ Cu, — bu, ) sin6, 4 lu, cos0, |j, 
(34.8) 
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通过 分 别 计 算式 (34.7) 和 式 (34.8) 中 向 量 
与 i My, 的 内 积 ， 以 及 应 用 式 (34.6)， 最 终 可 以 得 
到 以 下 系统 的 方程 组 

1 
E - de(s) 


s [ Cu, lu, )cosg. — l u,sin0, | 


d = (u, - lu, )sin8, +1,u,cos0, 


6. =u, -sc(s) 
(34.9) 

这 些 方程 是 式 (34.4) 的 一 个 推广 。 为 验证 这 
^ie. MH P 作为 参考 坐标 系 Fa 的 原点 CHI 
l, 21,2 0) ， 并 把 参考 系 F 的 坐标 轴 (0, i) il 
线 C 一 致 。 于 是 有 =x，c(s*) 20 (对 任意 *) ， 进 一 
步 , 令 y=d 和 60= 和 ， 即 可 准确 得 到 式 (34.4) 。 

对 于 轿车 型 车 辆 ， 基 于 式 (34.5) 很 容易 验证 
系统 式 (34.9) 可 化 为 


s 


Ul tan 中 
“dae [ cos@. L (I5cos0, +l sind, ) | 


La nib dod 3] 


d =u [sin0, + L 


omm 
a= 了 tan 由 -sc(s) 


& =u, 
(34. 10) 
(只 要 将 式 (34.9) 中 的 um =6 用 新 表达 式 6: 


(utan®)/L 替代 即 可 )。 简 言 之 , 我 们 得 到 如 下 


结论 o 


命题 34.1 

独 轮 车 型 和 轿车 型 车 辆 相对 于 Frénet 坐标 系 下 
的 运动 学 方程 组 可 分 别 由 系统 式 (34.9) Ask 
(34.10) 给 出 。 


34.3 面向 完整 性 系统 的 控制 方法 的 
适应 性 


我 们 将 在 本 节 中 讨论 轨迹 镇 定 问题 和 路 径 跟 踪 问 
题 。 当 我 们 在 引言 中 定义 这 些 问 题 时 ， 我 们 所 考虑 的 
是 附着 于 机 器 人 底座 上 的 一 个 参考 点 P。 事 实证 明 ， 
对 于 这 一 点 的 选择 是 很 重要 的 。 实 际 上 ， 例 如 对 独 轮 
车 上 的 一 点 已， 当 曲 线 C 为 坐标 轴 (0, i) 时 ， 我 们 
考虑 方程 式 (34.9), PA s=x,, d=y,, URO= 
6. 表示 了 机 器 人 相对 于 固定 参考 系 F 下 的 位 姿 。 根 
据 P 是否 在 驱动 轮 的 轴线 上 ， 可 以 有 两 种 可 能 情形 。 
我 们 考虑 第 一 种 情形 ， 其 中 7 =0。 从 式 (34.9) 中 


的 前 两 个 方程 可 知 %， -(u,-Lu) cos0, y, -(u,- 
lu,) sing。 这 些 关系 式 指 出 P HEUS (cosh, 
sind) 的 方向 移动 ， 这 是 小 车 所 受 非 完 整 约束 的 直接 
结果 。 现 在 ， 如 果 点 P 不 在 轮轴 上 ， 则 有 

X, cosü -l,sinü/1 -LWu, 

NL n L,cosO l 1 (£) 

(34. 11) 
方程 右边 的 两 个 方 阵 都 是 可 逆 的 ， 这 个 事实 表明 ，,、 
7 可 以 取 任 意 值 ， 因 此 点 P Bs ade SES RR 
通过 和 完整 性 的 机 械 手 臂 类 比 ， 这 意味 着 己 可 以 视 
为 一 个 具有 两 自由 度 的 末端 ， 因 此 它 可 以 通过 采用 与 
操纵 机 械 手 臂 相 同 的 方法 来 控制 。 在 这 一 部 分 ， 我们 
假设 用 来 刻画 机 器 人 位 置 的 已 点 ， 并 没有 选择 在 后 
轮轴 上 。 在 这 种 情形 下 ， 我 们 将 发 现 解决 轨迹 镇 定 问 
题 和 路 径 跟 踪 问 题 会 简单 很 多 。 然 而 ， 正 如 接 下 来 部 
分 所 显示 的 ， 在 轮轴 上 选择 P 点 ， 也 许可 以 更 有 利 
于 控制 小 车 的 方向 。 

34.3.1 非 约 束 点 的 轨迹 镇 定 

l. 独 轮 车 型 

考虑 平面 内 的 一 条 可 微分 的 参考 轨迹 上 9x, (D , 
y, G)), 用 e= (x, x. y -») 表示 位 置 的 跟踪 误 
差 。 控制 目标 是 要 渐 近 镇 定 误差 到 零点 。 从 式 
(34. 11) 中 可 得 误差 方程 为 


i» ned H 
sind — l,cos0 Uy y, 
(34. 12) 
引入 新 的 控制 变量 (v, v), TEMP: 
e) H Fold NE 
三 | (34. 13 ) 
V, sind — l,cos0 Uy 
则 式 (34. 12) 简化 为 
Vi x, 
0) 
Vy y. 
于 是 ， 就 可 以 应 用 镇 定 线性 系统 的 传统 技术 了 。 例 


如 ， 我 们 可 以 考虑 如 下 一 个 带 前 馈 补偿 的 比例 反馈 
控制 


y, =x, - he, =x, —h (x, —%,),(k >0) 
y, xy, - hye, zy, - hy, -y,) Ck; »0) 
由 此 得 到 的 闭环 方程 为 e = - Ke。 当 然 ， 这 个 控制 可 
以 用 初始 控制 变量 w 进行 重 写 ， 因 为 映射 (uu, uu) > 
(vi, v) 是 双 射 的 。 
2. 带 拖车 的 独 轮 车 型 
以 上 的 技术 可 以 直接 推广 到 一 个 或 几 个 拖车 钩 
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在 独 轮 车 型 的 小 车 上 的 情形 ， 只 要 点 P 取 在 远离 驱 
动 轮轴 ， 且 和 拖车 相 异 的 一 侧 。 除 此 之 外 ， 在 实际 
中 最 好 使 机 器 人 的 纵向 速度 uw 在 所 有 时 间 内 一 直 保 
持 正 值 ， 以 避免 所 有 车 之 间 ( 即 非 主动 受 控 变 量 保 
muon men) 的 相对 方向 角 的 取 过 大 的 
数值 ( 折 刀 效应 )。 这 个 问题 将 在 第 34.4 节 深 入 
讨论 。 

3. 轿车 型 

以 上 技术 也 可 以 拓展 到 轿车 型 车 辆 ， 只 要 将 P 
点 选择 附着 于 舵 轮 支架 上 ， 而 非 在 舵 轮 轴 上 。 


34.3.2 无 方向 控制 的 路 径 跟踪 


1. 独 轮 车 型 

我 们 采取 图 34. 4 的 记号 来 表述 跟踪 一 条 平面 内 
由 曲线 C 所 描述 的 路 径 问题 。 控 制 目标 是 使 距离 4 镇 
定 到 零点 。 由 式 (34.9) 可 得 


d =u,sinO, +w( -bsing. *1,cos6,) (34.14) 
回顾 在 这 种 情形 下 ， 和 车辆 的 纵向 速度 或 者 是 外 加 的 或 
者 是 预先 设 定 的 。 我 们 假设 乘积 Lu MARIER, 即 点 
P 相对 于 驱动 轴 的 位 置 与 u, 的 符号 相关 。 这 个 假设 
将 在 第 34.4 节 中 去 掉 。 简 单 起 见 ， 我 们 也 假设 2 = 
0， 即 点 己 位 于 坐标 轴 (Pu, in) 上 。 我们 考虑 下 面 
的 反馈 控制 定律 


u x sinô 
: ljcos0, ° 


式 中 ,是 一 个 定义 在 RR x(-m-2, 2) 上 连续 
的 严格 正 的 函数 ， 且 满足 k(dq，+7/2) =0。 由 于 
1,20, 应 用 控制 式 (34.15) 到 式 (34.14) E, 
可 得 


"i k(d,0,)d (34.15) 
os0. 


d = -liuk(d,0.)d 
由 于 和 处 均 保持 严格 正 ， 这 一 关系 暗示 1 dl TH 
控制 系统 中 的 任何 轨迹 均 是 非 增 的 。 要 使 4 收敛 到 
零 ， 需 要 满足 下 列 条 件 : 
1) u, 的 符号 保持 不 变 
2) 对 所 有 的 i， defi |@. (t) |>e>0, 


3) Mrosoolit, | Ju (s) ds © o 


一 个 条 件 是 可 以 满足 的 ， 例 如 ， 当 是 定常 数 。 
在 这 种 情形 下 ，4 将 指数 收敛 到 零 。 至 此 剩 下 的 事 '1 
是 检验 由 式 (34.15) 所 给 出 的 u, 是 始终 有 定义 的 。 
由 于 在 cos0. =0 时 方程 式 (34.15) 的 右边 是 没有 定 
SY, 我们 要 确定 系统 参数 和 初始 状态 值 所 要 满足 何 
种 条 件 能 够 保证 cos0. 不 会 达到 零 。 为 达到 这 一 目的 ， 
我 们 考虑 设 定 当 09. 从 下 (ME) 趋向 于 mm2 (-m/ 


uk 


2) 时 9. 的 极限 值 。 应 用 式 (34.9) 和 式 (34.15), 


并 设 =0， 通 过 简单 计算 可 得 
: els) . 
0.,-u, | -1 dip rs 
le(s) . (4 Kt] 
Heer pu L 十 od, 


下 面 ， 我 们 先 假设 o MATT r/2。 此 时 ，6. 极 限 
值 的 符号 直下 式 的 符号 给 出 | 


«(s 


为 避免 .达到 m/2, 需要 满足 符号 为 负 。 为 此 ， 要 
满足 
le(s) 
ut : «1 (34. 16) 
然后 ,假设 9. 从 上 面 趋向 于 -mw/2。 此 时 ，0., 极 限 值 


的 符号 由 下 式 的 符号 给 出 


liefs E 
[iG 

为 避免 9. 达到 -mw/2， 需 要 满足 符号 为 正 。 为 此 ,也 
是 要 求 式 (34. 16) 成 立 。 通 过 以 上 分 析 ， 我 们 得 到 
如 下 命题 。 

命题 34.2 

在 下 面 两 个 假设 基础 上 考虑 独 轮 移 动机 带 人 的 
路 径 跟 踪 问 题 : 

1) 纵向 方向 的 速 


度 ul 严格 为 正 , 或 者 严格 


WM, 

2) 在 车 辆 底座 坐标 系 中 ， 参 考点 P 的 坐标 为 
(4 19 0), HWE Lu, 20, 

用 下 表示 一 个 连续 函数 ， 它 在 民 x(-m2, 


7-/2) 上 严格 为 正 ， 且 满足 对 于 任意 d (PA kld, 
0.) 2k,cos0,) , EAA k(d, +7/2) =0 Mor, H 
么 ， 对 于 任意 满足 


HOV 9) TE E le 
的 初始 条 件 Cs d(0), 0,(0)), 其 中 Vue 
max, |c(s) |， 反 馈 控 制 
M u,tand, k(d,0,)d 
Zi n ! cos, 


会 使 得 P 和 曲线 之 间 的 距离 1 dl 不 再 增加 ， 进 一 
步 ， 在 满足 条 件 


INPTO, |ds—- o9 “ir+o 
时 收敛 于 零 。 
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2. 带 有 拖车 的 独 轮 车 型 

上 面 的 结果 也 适用 于 此 类 系统 ， 但 u 必须 为 正 
以 避免 折 刀 效应 。 否 则 ， 这 种 效应 会 发 生 (将 在 
保持 为 负 足 够 长 的 时 间 之 后 出 现 ) ， 因 为 车 辆 之 间 的 


方位 角 没 有 得 到 主动 的 监测 。 
3. 轿车 型 
这 种 控制 技术 也 适用 于 这 种 情形 ， 如 果 考 虑 到 点 


P WETIRE, Bu WIE. 
34.4 非 完整 系统 的 特定 方法 


前 一 部 分 所 叙述 的 控制 技术 具有 简单 的 优点 。 但 
是 ， 其 并 不 能 很 好 地 适用 于 所 有 的 控制 意图 。 它 的 一 
个 主要 局 限 在 于 它 要求 机 器 人 的 纵向 速度 的 方向 保持 
不 变 (参考 命题 34. 2 中 的 假设 ) 。 对 于 有 拖车 的 系 
统 ， 该 控制 技术 要 求 机 器 人 的 纵向 速度 必须 为 正 。 这 
一 条 件 / 限 制 与 没有 主动 监测 方位 角 变 量 有 关 。 为 了 
更 好 地 理解 它 的 原理 ,我 们 考虑 命题 34.2 给 出 的 
u, >0 时 的 控制 解 ， 且 假设 该 控制 在 为 负 (比如 ， 
RED, P 点 保持 不 变 时 也 被 应 用 。 图 34.5 给 出 了 一 
种 可 能 的 场景 。 选 定 的 曲线 是 一 条 简单 的 直线 ， 我 们 
假设 在 1=0 时 刻 ，P 已 经 在 曲线 上 ( 即 d=0)。 如 果 
u AK, HEP 被 限制 在 直线 上 ， 机 器 人 方位 角 的 幅 
值 | 0. | 会 迅速 增加 。 在 上 =1 时 刻 ，0. 达 到 —m/2, 3X 
个 时 刻 的 控制 表达 式 不 再 有 定义 (有限 时间 内 的 急 
剧 上 升 )， 而 且 因 为 速度 向 量 已 经 与 曲线 重 直 ,，P 不 
能 再 保持 在 曲线 上 。 


t=1 t=0 


图 34.5 反 向 纵向 速度 下 路 径 跟 踪 的 不 稳定 性 


关于 这 个 行为 的 解释 如 下 : 因为 方位 不 受 控制 ， 
方位 角 变 量 0. 有 其 自身 的 、 事 先 未 知 的 动态 特性 。 
它 可 能 是 稳定 的 ， 也 可 能 是 不 稳定 的 。 对 于 已 经 考虑 
过 的 控制 解 ， 我们 已 经 指出 它 在 u, >0 时 是 稳定 的 。 
特别 地 ，0. 保 持 在 反馈 控制 律 uw 的 定义 域 ( -5/2， 
7/2) Al, Su, <0， 这 种 动态 特性 变 得 不 稳定 ，0. 
达到 了 控制 律 定义 域 ( —-/2, m/2) 的 边界 。 这 种 
系统 未 直接 受 控 ( 系统 的 零 动态 ， 控 制 术语 ) 部 分 


的 不 稳定 性 会 以 同样 的 方式 出 现 拖车 被 引导 车 牵引 的 
时 候 。 当 纵向 速度 为 正 时 ， 牵 引 车 有 一 种 牵 拉 作用 ， 
倾向 于 使 跟随 者 对 齐 牵引 者 沿 着 轨迹 曲线 跟随 前 进 。 
在 其 他 情形 下 ， 牵 引 车 的 推 挤 作用 使 得 跟随 者 无 法 对 
齐 ( 折 刀 效 应 )。 为 了 消除 这 个 纵向 速度 符号 的 限 
制 ， 必 须 设计 控制 策略 ， 使 得 系统 在 所 有 的 方向 角 下 
都 能 主动 稳定 下 来 。 一 个 间接 的 方法 是 把 P 选择 在 
驱动 轮 的 轴 上 ， 且 位 于 轴 的 中 点 。 在 这 种 情形 下 ， 非 
完整 约束 更 加 明显 ， 且 无 法 应 用 完整 约束 调节 需 的 技 
术 来 得 到 控制 解 。 

这 一 部 分 的 结构 安排 如 下 : 首先 ， 与 Frénet 坐标 
系 相 关 的 建 模 公 式 被 重新 描述 为 称 作 链 式 形 式 的 标准 
形式 。 由 此 出 发 ， 给 出 一 种 包含 主动 镇 定 车 辆 方位 角 
的 路 径 跟 踪 问 题 的 解 。 然 后 重新 研究 增加 控制 车 辆 方 
向 角 目 标的 〈 可 行 ) 路 径 镇 定 问 题 。 接 着 研究 了 固 
定位 姿 的 渐 近 镇 定 问题 。 最 后 ， 讨 论 了 之 前 所 提出 的 
关于 渐 近 镇 定 控制 策略 的 局 限 性 ， 为 介绍 一 种 在 下 面 
部 分 提出 的 新 控制 方法 提供 动机 。 


运动 学 模型 向 链 式 形式 的 转换 


在 有 关 路 径 规划 的 下 一 章 里 ， 将 要 介绍 如 何 通 过 
改变 状态 变量 和 控制 变量 ， 把 移动 机 器 人 ( 独 轮 车 
型 的 ， 轿 车 型 的 ， 带 拖车 的 ) 的 运动 学 方程 转化 为 
链 式 形 式 。 特 别 地 ， 独 轮 车 型 方程 式 (34.4) 和 轿 
车 型 方程 式 (34.5) 可 以 分 别 转化 为 三 维和 四 维 的 
链 式 系统 。 带 有 N 节 拖 车 的 独 轮 车 ， 如 果 拖 车 之 间 
是 用 特定 方式 连接 的 ， 可 以 生成 一 个 N+3 维 的 链 式 
系统 。 如 下 所 示 ， 这 种 转化 可 以 推广 到 Frénet 坐标 系 
下 的 运动 学 模型 。 这 里 只 给 出 了 独 轮 车 型 和 轿车 型 的 
结果 (方程式 (34.9) 和 式 (34. 10))， 该 结果 也 适 
用 于 当 拖 车 固定 在 这 类 车 辆 上 时 的 情形 。 此 时 ， 参 考 
点 了 要 选 在 车 辆 两 个 后 轮轴 线 的 中 心 位 置 (如 果 有 
拖车 ， 参 考点 可 以 选择 最 后 一 节 拖 车 两 个 轮子 轴线 的 
中 心 位 置 ) 。 

我 们 先 从 独 轮 车 型 开始 。 假 设 P 是 坐标 系 F.M 
MA, Al, =1=0， 因 此 系统 式 (34.9) 可 以 简 
化 为 


34. 4.1 


cos, 


5 71 - de(s) 
P (34. 17) 


d = u sinô, 


ô. =u —sc(s) 
我 们 确定 一 个 坐标 和 变量 的 变换 (s, d, 0,, ui， 
Uy ) PG, £5, 235 WV, v), 使 原 系统 式 (34. 17) 
(局 部 地 ) 转化 为 三 维 的 链 式 系统 
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SS 34.4.2 ”相同 运动 学 特性 参考 车 辆 的 追踪 
à,» (34. 18) 
Dl 下 面 我 们 考虑 跟踪 同时 包括 车 辆 的 位 置 和 方向 的 
oe. aia "s 参考 车 辆 的 问题 ( 见 图 34.6) 。 与 之 前 仅仅 要 求 在 位 
ERES 置 上 跟踪 时 相反 ， 此 时 参考 点 P 的 选择 变 得 不 再 重 
a =s, iet. 要 ， 因 为 对 于 任意 P， 大 部 分 的 参考 轨迹 1 (x, 
我 们 已 经 得 到 2, =v,。 这 表明 (D), y(t), 600) 对 于 状态 向 量 Go, ys, 0) 而 
; 言 并 不 可 行 。 为 简便 起 见 ， 我 们 把 P 选 为 机 器 人 底 
d= u, sind, = a. [1 -dc(s) ]tan6, 座 坐 标 系 F, 的 原点 已 。 


=v, [1- dc(s) ]tan0. 
Kea, RITS z, =d, z = [1 - de(s) ]tan0, ABA E rj 
的 等 式 变 成 2, = vz。 最 后 ,我 们 定义 v, = :3 = 
| de(s) -d 263 Jano, + [1-de(s) I(1 t tan?0,) Ôo 


等 式 (34.18) 满足 如 此 定 的 变量 = 和 vw,。 

从 上 述 过 程 中 我 们 可 以 很 容易 地 确定 映射 Cs, 
d, 0.) 户 z 是 一 种 定义 在 RR* x ( -mm2，m2) (更 
严格 地 ， 应 该 把 限制 1d| <1/c (s) 考虑 在 内 ) 上 的 
局 部 坐标 变换 。 最 后 我 们 注意 到 控制 变量 的 变换 包括 
路 径 曲 线 (计算 中 要 用 到 这 部 分 信息 ) 的 微分 9c/9s。 
类 似 地 ， 我 们 可 以 把 轿车 型 系统 的 方程 转化 为 四 维 链 
式 系统 ， 但 是 计算 要 稍微 繁杂 些 。 我 们 会 在 下 面 的 命 


题 中 总 结 这 些 结果 。 


命题 34. 3 

由 (zi, 2, 2) =(s, d, [1-dc(s) ]tan0,) , 
(xj, v) 2(4, 23) 定义 的 坐标 和 控制 变量 变换 
《人 可 
以 把 独 轮 车 模型 式 (34.17) 转化 为 三 维 链 式 
系统 。 

类 似 地 ， 由 

Cra a= sd, L1 -de(s) Jianð,, 


—-c(s) [1 de(s) ] (1 +2tan’@, ) 


- d ^ anf, £[1-de(s)]? 


tang 1 E 
L cos0. 

(1) 5) St rs) 
定义 的 坐标 和 控制 变量 变换 (s, d, O., Q, wy, 
Uy) (zi, Z2, Z3, Z4» Py. V2)， 可 以 把 轿车 型 模 
型 式 (34.10) (满足 1 =L =0) 转化 为 四 维 的 链 
HA 


图 34. 6 参考 车 辆 及 误差 坐标 


尽管 术语 并 不 严密 ， 从 控制 角度 而 言 ， 跟 踪 问 题 
通常 与 参考 轨迹 的 渐 近 镇 定 相 关 。 这 种 情形 下 ， 参 考 
轨迹 可 行 是 控制 律 存 在 的 一 个 必要 条 件 。 可 行 的 参考 
轨迹 t 9. (x, (0), y, (2, 0,00). 是 平滑 的 时 间 函 
数 ， 这 些 函 数 是 机 器 人 运动 学 模型 在 某 些 特定 控制 输 
At E9u (0) = (ww,(t)，w,,(1t)) ( 称 为 参考 控制 ) 
时 的 解 。 例 如 ， 对 于 独 轮 车 型 的 机 器 人 ， 按 照 式 
(34.4) 的 规定 有 下 面 的 形式 


X, =U, „€030, 


y, = u, ,sinO, 


(34.19) 


0,-u,. 
换 名 话说， 可 行 的 参考 轨迹 与 参考 坐标 系 的 运动 是 一 
HY, BSR F, =1P., i, j) 严格 依附 于 所 参 
考 的 独 轮 式 机 器 人 ， 其 中 已 位 于 两 个 主动 轮 的 轴线 
中 心 位 置 (类 似 于 P=P,) ( 见 图 34.6) 。 由 此 出 发 ， 
问题 可 以 转化 为 确定 一 种 反馈 控制 律 ， 使 跟踪 误差 
(x-x,, y-y,, 0-0,) 能 够 渐 近 镇 定 到 零点 。 其 中 
(x,, y,) 是 点 书 在 坐标 系 中 的 坐标 ，0, 是 i 和 i 之 
间 的 方位 角 。 我 们 可 以 像 在 路 径 跟 踪 问 题 中 一 样 处 
理 。 首 先 建立 坐标 系 Ff, 下 的 误差 方程 ,然后 通过 与 
之 前 将 移动 机 器 人 的 运动 学 模型 转化 为 链 式 模型 类 似 
的 变量 变换 ， 将 方程 转化 为 链 式 模型 ， 最 后 ， 对 转化 
后 的 系统 设计 镇 定 控制 律 。 
在 坐标 系 下 下 用 (x -* ，y -y,) 表示 位 置 跟踪 
误差 ， 我 们 可 以 得 到 向 量 ( 见 图 34.6) 


x, cos0, sinô, \/x — x, 
= . (34. 20) 
y, —sinÓ, cos0. Ay — y, 
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对 时 间 求 导 我 们 可 以 得 到 
x, .( -sinü, cosO, Mx —x, 
=0, 

y. "A7 cos0, -sinü, Ay — Y, 

cosÜ, sin, \( x — x, 

H a . LI 

-sinü, cos0, À y — y, 
p *u,cos(0—0,) -u ‘| 


— Uy x, +u,sin( 6 —0,) 


用 0. 20 - 0, RANGA Fa MF, 之 间 的 方位 角 误 差 ， 
我 们 可 以 得 到 


X, =U, „Ye + uj cosÓ, —u, , 


y. = -= u, „Xe +u sinô, (34.21) 
6, = Uy — U2, 

为 了 确定 控制 律 (u, uQ) 使 得 误差 (x, Ve 0) 
能 够 渐 近 镇 定 到 零点 ， 我 们 考虑 下 面 的 坐标 和 控制 变 


量变 换 (5, Ye» 0. , uy, Uy ) > (24,, 20, 235 Wi, 


w, ) ’ 其 定义 如 下 : 


Z 25x, 
Z,-y. 
z; =tand, 


wi —-u,cos0, —-u, , 


U, — Uy 


Ww, = 


cos? 0, 
需要 注意 的 是 ， 在 零点 附近 ， 只 有 当 b. es (- 7/2, 
7/2) 时 ， 这 个 映射 才 有 定义 。 换 名 话说 ， 实 际 的 机 
器 人 与 参考 机 器 人 方位 角 之 间 的 误差 必须 要 小 于 
T/2, 

使 用 新 的 变量 后 ， 容 易 验 证 系统 式 (34.21) 可 
以 写 为 


Z1 = Uy 2) Ww 

22 = —db „Z, + Uy „Z3 + WIZs (34. 22) 
z; =w, 

上 面 三 个 方程 中 每 个 方程 的 末 项 对 应 着 一 个 链 式 系 

统 ， 因 此 我 们 就 有 如 下 的 结果 。 


命题 34. 4 
控制 律 方程 
n SS [u,. |(z, 2,2) (ki >0) 
dn, = DUTIES — k, [ue lz, (k, ,k; >0) 
(34. 23) 


使 得 系统 式 (34.22) 的 原点 为 全 局 渐 近 稳定 的 ， 
如 果 uw ,是 一 个 有 界 可 微分 函数 ， 其 导 函 数 有 界 并 
且 当 4 趋 于 无 穷 时 导 函 数 不 趋 于 0。 


1. 备注 

通过 与 第 34. 3 节 的 结果 比较 ,我 们 注意 到 ,很 
可 能 穿 过 零点 并 改变 其 符号 。 

2. 证 明 

考虑 如 下 正定 函数 


lf(2,2, 12 
V(z) =4-(4 dá) 
V 沿 控制 系统 (X (34.22) 和 式 (34.23)) 轨迹 的 
时 间 导 数 由 如 下 方程 给 出 : 


. 1 
V zz,w, +2, (Wy 2, Tz) +—z,W, 


k, 


1 

-w(z tna) (u.s 十 A w) 

2 k, 

= -k | uy. |(z tmm) CN 

因此 , 了 沿 着 任意 一 条 轨迹 都 是 非 增 的 ， 并 且 其 极限 
收敛 于 某 一 有 限 正 值 Vi, =>=0。 这 也 就 意味 着 变量 > 、 
z 和 zz 都 是 有 界 的 。 因 为 ui ,是 有 界 并 且 导 函数 有 界 ， 
得 出 |u, | 是 一 致 连续 的 。 因 此 ”是 一 致 连续 的 ， 并 
HARI Barbalat 引 理 ， 当 1 TESH, V 趋 于 0。 通 
过 VV 的 表达 式 可 以 得 出 ui ,zs 和 u (zi *2,2,) (因此 
也 有 二) 趋 于 0。 换 句 话 说， 通过 表达 式 w, = 2, 
只 要 满足 方程 : 


| Uir lz 


3 
Ur lz; — k u 22 


d,» | 
a ui un) = Dib uy t — gus, 
并 且 是 在 表达 式 
L Ga z) haud un 


得 出 的 结果 都 是 趋 于 0。 由 于 wi ,有 ,一 致 连续 ( 

身 连续 且 导 函数 有 界 )， 并 且 由 于 wi ,a 趋 于 0， 通 过 

应 用 Barbalat 引 理 的 一 个 推广 形式 就 可 以 得 出 wi ,zs 

(同时 也 有 wi ,zs) BFO WERAK V, uwz (i= 

1, 2, 3) WFO 表明 u, V 收敛 于 0， 因此 假定 

u, ,不 趋 于 0 就 可 以 得 到 V 20 和 Vi, =O 的 结论 。 

对 控制 规律 式 (34. 23) 的 线性 化 就 得 到 了 一 个 

更 简单 的 控制 律 
wi = -k, | uy, lz, 

(e = — kyu 2 -k, [us [zs 


W ~ Uy = Wr, 所 以 


» - ot 


因为 在 原点 附近 有 w mu, -uss 
就 可 以 很 合理 地 推测 控制 律 
=u), -k [u,, lz, 


Uy = Uy, ku, zy — k, | u, lz 


是 否 能 用 于 系统 式 (34.21), BRE, ftf £e HL BS 
极点 配置 计算 ， 并 不 难 验 证 ， 当 u, Fus ,是 常数 时 ， 
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并 且 u, AO 时 ， 这 个 控制 律 渐 近 镇 定 到 由 系统 式 
(34.21) 近似 得 来 的 线性 系统 的 原点 。 这 样 ， 当 u, 
All u, ,满足 上 面相 同 的 条 件 ， 它 也 局 部 渐 近 镇 定 系 统 
式 (34.21) 的 原点 。 这 也 意味 着 ， 系 统 增益 ky.) 
调节 可 以 通过 应 用 经 典 线性 控制 技术 于 系统 式 
(34.21) 的 近似 线性 系统 来 实现 。 针 对 特定 速度 
uy =l, u, 20 的 调节 控制 规律 式 (34.23) 事实 上 
也 可 适应 于 其 他 任何 速度 的 调节 (当然 排除 u, =0 
的 情形 ， 因 为 这 种 情形 下 系统 式 (34.21) 的 近似 线 
性 系统 是 不 能 控 的 ， 控 制 失效 了 )。 事 实 上 ， 在 所 有 
控制 增益 之 前 乘 上 + uw,， 将 简化 受 控 系统 关于 纵向 
速度 方程 的 正则 化 过 程 ， 使 得 当 小 车 接近 参考 小 车 的 
过 程 中 的 瞬时 路 径 和 纵向 速度 的 大 小 相互 独立 。 

3. 扩展 到 轿车 型 车 辆 

我 们 把 之 前 的 方法 扩展 到 轿车 型 车 辆 的 情形 。 我 
们 在 下 面 提供 扩展 的 主要 步 又 ， 把 具体 细节 的 证 明 留 
给 有 兴趣 的 读者 自己 完成 。 

根据 轿车 型 车 辆 的 运动 学 模型 式 (34.5), JF H 
补充 参考 小 车 的 模型 如 下 


X, =U, ,cosd, 


y, =u, „sin, 

. ly (34. 24) 
0.- “land, 

$, = Uy, 


我 们 假设 存在 一 个 6e (0, 1/2) 使 得 方向 角 4$, 属 于 
区 间 [ -6, 8]. 
通过 定义 x,.、y, 和 0.， 就 像 独 轮 车 型 车 辆 情形 里 
一 样 ， 并 且 通 过 设 定 $. = 下 ,， 我 们 很 容易 得 到 如 
下 方程 ( 同 式 (34.21) 比较 ) 


. U, 
x= ( j land, y. Fu,cos0, —u, , 


y,-- (ne, y. + uising, 
(34. 25) 


a =, uy, 
SE ano 一 L tano, 


d. Uy — Uy 
引入 了 新 的 状态 变量 : 


Z =X, 


ag Ys 
zs =tand, 


tano 一 es TTE 
Lcos 0, 


我 们 注意 到 对 任意 由 e ( - 7/2, 7/2), 映射 (x.， 
y,, 6, 6) Foz fER^ x ( -m/2, m/2) TIR 之 间 定 


Z4 = 


义 了 一 个 微分 同 胚 映射 。 现 在 就 引入 了 新 的 控制 变 
W, -u,cos0, — U, , 


: à 3tand 
w, = 24 =k, Y. + (225 


n 


inĝ, . 
2tand, T 0. 


Uu. Ug 
2 29 + 2 3 
Leos’ 路 cos 0, Leos dcos 0, 


(34. 26) 

这 个 方程 表明 映射 (uy, u) (w, w) 定义 

了 变量 在 区 间 (—m-2, 7/2) 上 的 转变 ， 这 些 状态 

和 控制 变量 的 变化 把 系统 式 (34.25) 转化 成 了 如 下 
的 形式 


Ws 
a> (ne, } + wi 


uy , 
2, = ( j and, k FU, 23 十 20123 


: , tand, 
23 = —hyuy m +14 24 + WI (z kyz, +(1 +3) ane | 
24 =, 
(34. 27) 
命题 34. 4 于 是 就 变 成 了 : 
命题 34. 5 
控制 律 
和 tano, 
pd (1*2) L ] 
(e = os =k, | Uir lz, 
(34. 28) 


AP, ko: 4 均 为 正 数 ， 使 得 系统 式 (34.27) 的 
原点 为 全 局 渐 近 稳定 的 ， 如 果 (1) u ,是 有 界 可 微 
函数 ， 它 的 导 函 数 有 界 ， 并 且 当 上 趋 于 无 穷 时 导 画 
数 不 趋 于 0, (ii) |Q, |58 <T/2。 

就 像 独 轮 车 型 情形 一 样 ， 增 益 系数 可 以 通过 控 
制 系统 的 线性 化 调节 。 更 确切 地 说 ， 我 们 可 以 从 式 
(34.25), IÈ (34.26), IÈ (34.28) 中 验证 , 在 坐 
ERN = (x, Yes 0.0,/L) 中 ， 控 制 系统 的 线性 化 可 以 
在 n=0 时 得 到 ， 当 w= (1,0) Bj, 线性 系统 方程 
Am =An, HP 


0 -khk, -k -k 
通过 选取 适当 的 增益 系数 就 能 使 特征 多 项 式 
P(A)=(A+th) (A? kA lA +h k,) 具有 理想 
的 根 。 非 线性 反馈 式 (34.28) 的 设计 是 为 了 保证 满 
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足 命 题 34. 5 中 收敛 条 件 的 情形 下 ， 当 ,的 大 小 不 为 
1 并 且 / 或 者 任意 变化 时 仍然 能 够 得 到 较 好 的 结果 。 

图 34.7 中 的 仿真 结果 阐述 了 这 种 控制 策略 的 效 
SR, WAR ARM k BUEN (k, ky kh, k)-(l,l, 
3，3) 。 参 考 车 辆 的 初始 位 姿 ( 即 在 :=0 时 刻 ) TE 
图 34. 7a 中 用 虚线 表示 , 为 (x,, y, 0) (0) = (0, 
0, 0), ZEE til Et ust (34.29) 来 定义 。 实 际 
机 器 人 的 初始 位 姿 ， 在 图 中 用 实 线 表示 ， 为 (x, 
y,, 0) (0) 2 (0, -1.5, 0), 在 :=10，20，30 时 
机 器 人 的 状态 也 在 图 中 表 出 。 由 于 跟随 误差 很 快 收敛 
于 0， 因 此 可 以 认为 两 个 小 车 在 := 10 后 状态 一 致 。 


(1,0)* t€ [0,10] 

u,(1) 24( -1,0.5c0s(27(¢-10)/5))" t&[10,20] 
(1,0)" te [20,30] 

(34.29) 


图 34.7 参考 车 辆 的 跟踪 


a) FJER FIZ b) 误差 一 时 间 坐 标 系 


34.4.3 包含 方向 控制 的 路 径 跟 踪 


度 的 符号 无 关 。 
1. 独 轮 车 型 情形 
我 们 在 第 34.4.1 节 已 经 看 到 如 何 将 与 Frénet 坐 
标 系 有 关 的 运动 学 方程 转换 为 三 维 的 链 式 系统 。 
Zi 
Z = Vz (34. 30) 
23 =V, 
回顾 (z,, z, 2) =(s, d, (1—de (s)) tan0,) 和 
v, =u,/1—de(s) cosg.。 目 标 是 确定 一 个 控制 律 渐 近 
镇 定 (d=0，6. =0)， 并 且 在 受 控 系统 的 轨迹 上 始终 
满足 对 d 的 约束 条 件 (比如 说 |dc (s) | <1)。 对 于 
这 个 控制 律 来 说 ， 最 可 能 考虑 包括 的 就 是 比例 反馈 ， 
比如 


Vy = 一 Za2z2 一 |v, [haz (k, ,ks >0) 
(34.31) 
然后 就 能 直接 证 明 出 闭环 子 系统 
22 = Vz3 
2, = —Vik,z, 一 |v, | 局 za ae 


KR, WR ERE, AIC EE 
还 是 负 值 。 由 于 wu，( 不 是 vw ) 是 车 辆 的 纵向 速度 值 ， 
我 们 更 愿意 建立 依赖 于 u 的 稳定 性 条 件 。 下 面 的 结 
果 提 供 了 一 个 一 般 的 稳定 性 的 条 件 ， 并 给 出 了 一 个 满 
足 限 制 | de(s) | «1 的 充分 条 件 。 

命题 34.6 

考虑 由 式 (34.31) 所 控制 的 系统 式 
(34. 30) ， 并 假设 初始 条 件 
[2 (0),2,00) ] =[d(0), 11 - d(0) c[ 5(0) ] | tan6, 
(0) ] 满足 


1 


2 
€, 


max 


m 1 2 
z; (0) Ws < 


TF, cu, = max, |c(s) MA, ZERREN 
解 满足 限制 条 件 | de(s) | <1。 此 外 ， 函 数 


V(z) =+(4 +74) (34.33) 
沿 系统 的 任意 轨迹 z(1) ABLE AY, HÆ 


FERM, Vle) ] 趋 近 于 0， 如 果 (举例 来 说 ) 
m 是 一 个 有 界 的 可 微 时 间 函 数 ， 其 导 函 数 有 界 ， 
并 且 在 1 趋向 于 无 穷 时 不 趋 近 于 0。 

这 一 证 明 类 似 于 命题 34. 4 的 证 明 ; 简单 的 计算 


我 们 重新 考虑 路 径 跟 踪 问 题 ， 假 设 参考 点 尸 位 
于 两 个 驱动 轮轴 线 中 点 的 位 置 上 。 目 标 是 设计 一 种 新 
的 控制 策略 使 小 车 能 够 稳定 地 跟踪 路 径 ， 而 与 纵向 速 


显示 ， 函 数 V 沿 着 受 控 系统 的 任意 解 都 是 非 增 的 ， 它 
收敛 于 某 个 有 限 值 Vi,, 。 重 复 在 命题 34.4 的 证 明 中 所 
使 用 的 那些 讨论 可 以 同样 地 表明 Vin =0。 
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注意 到 对 于 的 限制 相当 弱 。 
号 不 一 定 保 持 恒定 。 

从 实用 的 角度 看 ， 很 
控制 作用 。 更 精确 地 ， 我 们 定义 变量 za 如 下 : 


特别 地 ，w 的 符 


LIA z, (0) «0 
控制 规律 式 (34.31) 可 按 如 下 方式 修正 : 
a |», | kožo -v ky, 一 lv, |k;z; 
i (ko , k, ,ks >0) 
=- Hun hy | is = Z kz, — |; kz, 0 3 


(34. 34) 


y 
n 


命题 34.7 
考虑 由 式 (34.34) 控制 的 系统 式 (34.30), 
EPAX kon k, k tE TET 


s ths tks +k, 
是 Hurwitz 稳定 的 〈 这 个 多 项 式 的 所 有 根 具 有 负 实 
部 ) 。 假 定 初始 条 件 [z,(0), 4(0)] =[d(0), 
{1-d(0)c[s(0)]} tan0,(0) ] 满足 : 


z, (0) + 


2 1 
3 polos 
那么 , 受 控 系统 的 任意 解 均 满足 限制 条 
1。 此 外 ， 函 数 


UE i +2(t) + 


fF | de(s) | < 


RAO 

沿 系统 的 任意 轨迹 2 (1) 都 是 非 增 的 ， 且 在 趋向 
于 无 穷 时 趋 近 于 0， 如 果 (举例 来 说 )u, 是 一 个 有 
界 的 可 微 的 时 间 函 数 ， 且 其 导 函 数 亦 有 界 并 在 ch 
向 于 无 穷 时 不 收敛 于 0。 


2. 推广 到 轿车 型 和 带 拖 车 的 独 轮 车 型 

除了 控制 律 简单 和 关于 其 稳定 性 的 需求 条 件 
少 ， 这 种 类 型 方法 的 一 个 优点 就 是 可 以 比较 直接 
地 推广 到 轿车 型 和 带 拖车 的 独 轮 车 型 的 情形 。 相 
关 结 果 将 在 下 个 命题 中 给 出 。 考 虑 如 下 n 维 链 式 
系统 


Zz, =v, 
Z2 =V] 23 


(34. 35) 


Z, =n, 
AP, n=3, C WEH ESEE Be JE. 
n=4 对 应 于 轿车 情形 (第 34.4.1 5), 


xt Para N 


个 拖车 的 独 轮 车 型 ,我们 有 n=N+3。 回 顾 前 面 可 
知 ， 在 所 有 人 情形 下 ，z, 表示 路 径 和 位 于 最 后 一 辆 拖车 
两 个 后 轮轴 线 中 心 点 之 间 的 距离 d。 

命题 34.8 

ZU) kh, e, k EAU S +k s +k, 
sis tds + 是 Hurwitz 稳定 的 。 基 于 这 些 参 
数 ， E 

[MA X sign(v,)"""kz, (34.36) 


那么 ,存在 一 个 正定 矩阵 Q@ ( 它 的 元 素 取决 于 系数 
万 )， 使 得 当初 始 条 件 [z, (0), z (0), 
z,(0)] 满足 


IL (0) 125 (0) 77,2, (0) lp <= 


时 ， 限 制 | de(s) | <1 对 控制 系统 的 任何 解 都 是 成 
A heis AAO aa IMS 
沿 着 系统 的 任何 轨迹 都 是 非 增 的 且 当 ; 趋 近 于 无 穷 
时 趋 近 于 零 ， 如 果 (举例 来 说 ) u, 是 一 个 有 界 可 
微 函 数 ， 且 它 的 导 函 数 是 有 界 的 ， 当 1 趋 近 于 无 穷 
时 导 函 数 并 不 收敛 于 零 。 

3. 备注 

HIMA s, c (s) =0 (也 就 是 说 ， 路 径 是 一 条 
直线 ) 时 ， 条 件 式 (34.37) 总 是 满足 的 。 在 实际 应 
用 中 当 6 比较 小 的 时 候 ， 要 求 会 降 得 很 低 。 也 要 注 
TA, JEEE Q 当做 参数 的 函数 显示 地 计算 出 来 
的 可 能 性 是 有 的 (详细 细节 可 见 参 考 文献 [34. 1] ) 。 

对 于 三 维 情形 ， 一 种 可 能 是 给 控制 加 一 个 积 4 
项 。 此 时 ， 可 以 从 一 个 扩充 系统 的 表达 式 中 计算 出 控 
制 律 ， 扩 充 系统 的 状态 向 量 由 变量 z; s, z 和 满足 
žo =V z WIERE za 组 成 。 因 为 增加 变量 2, 保留 了 
系统 的 链 式 结构 ， 控 制 律 表 达 式 可 以 很 容易 地 从 n+ 
1 维 没有 积分 项 的 系统 控制 律 中 得 到 。 更 准确 地 说 ， 
可 以 得 到 如 下 表达 式 


(34. 37) 


= 


; n 
= s n : n4l-i 
v, 2 — kyv,sign(v,)" x [res -v > sign(z ) kz, 
t=2 


其 中 参数 大 使 得 多 项 式 Est. +k, js" tee ths 4 
是 Hurwitz 稳定 的 。 

图 34. 8 给 出 的 仿真 结果 说 明了 这 种 控制 律 是 如 
何 对 轿车 型 车 辆 起 作用 的 。 参 考 曲 线 是 以 原点 为 圆 
心 ， 半 径 为 4 的 圆 弧 。 d cios BE 由 定义 为 
当 ie[0, 5]; ， 当 上 >5。 控 制 增益 
E TE ds 
平面 上 的 运动 如 图 34. 8a 所 示 ， 它 在 1=0、5 和 25 时 


wu =l, u = 一 
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的 位 姿 也 表示 在 图 中 。 变 量 z, ，z;，z (命题 34.3 所 
定义 的 ) 随时 间 的 变化 表示 在 图 34. 8b 中 。 可 以 看 
到 ， 纵 向 速度 在 1=5 时 的 变化 并 不 影响 这 些 变量 收 
敛 到 零点 。 


b) 


沿 着 圆 弧 的 路 径 跟 踪 
a) 第 卡 儿 坐标 系 下 的 运动 b) z, zy. oz, —HERI AK 


图 34.8 


34.4.4 固定 位 瓷 的 渐 近 镇 定 


现在 我 们 考虑 一 个 机 器 人 底座 在 固定 期 望 ( 参 
考 ) 位 姿 (即位 置 和 方向 ) 的 渐 近 镇 定 问题 。 这 个 
问题 可 以 看 作 路 径 追 踪 问 题 的 一 个 极限 情形 。 然 而 ， 
本 章 前 面 提出 的 所 有 反馈 控制 器 都 不 能 很 好 地 解决 这 
个 问题 。 例 如 ， 在 第 34.3 节 ， 尽 管 可 行 轨迹 的 位 置 
镇 定 结果 也 不 排除 轨迹 退化 为 一 个 点 的 情形 ， 但 此 时 
仍然 无 法 保证 车 辆 的 方向 稳定 性 。 至 于 第 34. 4 节 的 


SEER, “SOLAS ASAE AIOE, ASR PE 
被 证 明 可 以 收敛 到 零 ,， 但 是 并 不 包括 固定 位 姿 的 
情形 。 

从 自动 控制 的 观点 来 看 ， 固 定位 姿 的 渐 近 镇 定 与 
纵向 速度 不 为 零 的 路 径 跟随 和 轨迹 跟踪 很 不 一 样 ， 如 
同一 个 司机 所 了 解 的 那样 ， 从 经 验 上 来 讲 ， 把 一 辆 车 
停 在 一 个 精确 的 位 置 所 用 到 的 技术 和 技巧 与 在 马路 上 
行驶 时 所 用 到 的 不 同 。 特 别 地 ， 它 无 法 使 用 任何 可 应 
用 于 线性 系统 (或 者 基于 线性 化 的 ) 的 经 典 控制 方 
法 来 解决 。 从 技术 上 来 讲 ， 最 根本 的 一 般 性 问题 是 能 
控 的 无 漂移 系统 在 控制 输入 个 数 少 于 状态 变量 个 数 时 
的 渐 近 镇 定 问题 。 这 个 问题 在 上 世纪 最 后 一 个 十 年 里 
激励 许多 学 者 从 各 种 不 同 角度 进行 了 大 量 的 研究 ， 而 
且 这 个 主题 在 之 后 五 年 仍然 保持 是 研究 热点 。 迄 今 为 
止 已 经 提出 了 各 种 各 样 的 候选 解决 方案 ,它们 背后 所 
采用 的 数学 技术 ， 以 及 没有 解决 的 困难 和 限制 ， 特 别 
是 (但 不 仅仅 ) 和 鲁 棒 性 方面 (这 个 问题 我 们 后 面 会 
讨论 到 ) ， 使 我 们 无 法 全 面 地 覆盖 这 个 主题 。 取 而 代 
之 ,我 们 选择 在 某 种 程度 上 不 规范 地 阐述 一 些 已 经 考 
虑 的 方法 ， 同 时 会 涉及 一 些 控制 方法 的 算 例 ， 但 不 会 
涉及 过 多 技术 与 数学 细节 。 

这 个 问题 激发 了 大 量 的 关于 非 完 整 系统 控制 的 研 
究 。 问 题 的 一 个 主要 方面 在 于 使 用 仅仅 依靠 状态 的 连 
续 反 馈 〈( 即 连续 的 纯 状 态 反馈 ) 无 法 实现 平衡 点 
(或 固定 点 ) 的 渐 近 镇 定 。 这 是 Brockeu 在 1983 年 的 
一 个 重要 结论 (可 以 参考 第 17.4. 2 节 的 相关 注释 ) 。 
他 最 初 的 结果 仅 考 虑 了 可 微 的 反馈 形式 ， 后 来 这 些 又 
被 推广 到 一 个 更 大 的 仅 限于 连续 的 反馈 的 集合 。 

定理 34.1 

(Brocket ^? ) 考虑 一 个 控制 系统 守 = f(x, 
u) (xeR", ueR”), 其 中 函数 f 是 可 微 的 ,， H. 
(x, u) = (0, 0) 是 这 个 系统 的 一 个 平衡 状态 。 存 
在 一 个 连续 的 反馈 控制 a(x) 使 得 闭环 系统 工 = 
f(x, u (x)) 的 原点 是 渐 近 稳定 的 一 个 必要 条 件 
是 映射 (x, u) f(x, u) 是 局 部 满 射 的 。 更 准 
WüHbUi, ÆRA (0, 0) 的 任何 邻 域 0 "i f Br 
映射 的 像 必须 也 是 民 "中 0 的 邻 域 。 

这 个 结果 意味 着 许多 能 控 ( 非 线 性 ) 系统 的 平 
衡 点 无 法 由 连续 的 纯 状 态 反馈 渐 近 稳定 。 所 有 非 完 整 
的 轮 式 移动 机 器 人 系统 都 属于 此 类 系统 范畴 。 这 会 在 
下 面 的 独 轮 车 型 机 器 人 情形 中 给 出 说 明 ; 而 其 他 类 型 
移动 机 器 人 的 证 明 也 是 类 似 的 。 因 此 我 们 考虑 一 种 独 
轮 车 型 车 辆 ， 它 的 运动 学 方程 式 (34.4) 可 以 写作 
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x=f (x, u), EP x2(x,, x, x)", u = (u, 
uw)", 有 f(x, u) = (u,cosx,, u,sinx,, u)', RAI 
这 里 要 指出 在 (x, u)=(0, 0) 的 邻 域内 /并 不 是 
局 部 映射 的 。 为 了 说 明 这 个 问题 ,我 们 取 R 中 的 一 
个 向 量 (0, 5, 0)"。 很 明显 方程 f(x, u) = (0, 8, 
0)'fE (x, u) =(0, 0) 的 邻 域内 无 解 ， 因 为 第 一 个 
等 式 u,cosx, =0 意味 着 u, =0， 因 此 第 二 个 等 式 在 6 
不 为 零 时 无 解 。 

我 们 也 可 以 很 明显 地 得 到 ， 独 轮 车 型 运动 学 方程 


和 轿车 型 机 器 人 的 情形 下 对 这 种 方法 进行 演示 。 为 了 
考虑 三 维 的 情形 ， 我 们 回顾 在 第 34. 4.3 节 路 径 跟 随 
中 得 到 的 结果 。 我 们 已 经 获得 了 应 用 到 系统 

Zz, =), 

Z2 = V1Z3 

Z; =n, 


ERIRE n, = -vhsy — |v, kz, (命题 34.6), 使 
得 由 式 (34.33) 定义 的 函数 了 (2) 沿 着 受 控 系 统 的 


的 线性 近似 (在 平衡 点 (x, u)=(0, 0) 附近 ) 是 
不 可 控 的 。 如 果 可 控 ， 就 可 以 用 一 个 线性 (也 是 连 
续 的 ) 状态 反馈 (局 部 地 ) 渐 近 镇 定 这 个 平衡 点 。 

因此 ， 根 据 上 面 的 理论 ， 一 个 独 轮 车 型 移动 机 器 
人 (AWARE SCRE DL AE A RE) 不 可 能 使 用 连续 纯 
状态 反馈 渐 近 镇 定 在 一 个 期 望 的 位 姿 (位 置 /方向 ) 。 
这 种 不 可 能 性 激发 了 解决 这 个 问题 的 其 他 控制 策略 的 
发 展 。 三 类 主要 被 考虑 的 控制 策略 是 : 

1) 连续 时 变 反 馈 。 这 种 策略 不 仅 依 赖 状 态 x, 
还 依赖 外 部 的 时 间 变 量 (也 就 是 用 w(x, 0 HORE 
RR GPA u(x) )。 

2) 非 连 续 反 馈 。 形 式 上 与 传统 形式 相同 ， 即 为 
(x)， 只 是 函数 在 所 期 望 镇 定 的 平衡 点 处 不 是 连续 的 。 

3) 混合 的 离散 /连续 反馈 。 尽 管 这 类 反馈 定义 
得 并 不 像 其 他 两 种 控制 一 样 精 确 ， 它 主要 包括 时 变 反 
馈 ， 要 么 连续 要 么 不 连续 ， 使 得 依赖 于 状态 的 那 部 分 
控制 策略 只 是 周期 性 地 更 新 ， 例 如 ， 对 于 任意 e 
[ET, (k«1) T], u(t) =a[x(kT), i], Kp T RA 
一 个 恒定 的 时 间 间 隔 ，ke N。 

我 们 现在 开始 解释 这 些 方法 ， 事实 上 ， 我 们 这 里 
只 考虑 时 变 和 混合 反馈 方法 。 主 要 的 原因 是 离散 的 反 
馈 会 涉及 很 多 困难 的 问题 ( 解 的 存在 性 ， 解 的 数学 
意义 等 ), 分 析 起 来 很 复杂 ， 也 得 不 到 完整 的 解答 。 
而 且 ， 对 于 大 部 分 在 文献 中 提 到 的 离散 控制 策略 ， 对 
于 李 雅 普 诺 夫 意 义 下 稳定 性 的 讨论 ， 要 么 不 满足 ， 要 
么 就 还 是 一 个 悬而未决 的 问题 。 

1. 时 变 反馈 

为 了 克服 Brockett 定理 的 障碍 ， 针 对 非 完 整 的 轮 
式 机 器 人 的 固定 期 望 平衡 点 的 渐 近 镇 定 所 使 用 的 时 变 
反馈 是 最 早 在 参考 文献 [34.3] 中 提出 的 。 从 那 以 
后 ， 针 对 非 线 性 系统 镇 定 而 采用 时 变 反 馈 方法 也 得 到 
了 非常 一 般 性 的 结果 。 例 如 ,已 经 证 明 对 于 任何 可 控 
的 无 漂移 系统 ， 其 任意 的 平衡 点 都 能 通过 参考 文献 
[34.4] 所 提出 的 控制 策略 来 实现 渐 近 镇 定 。 这 也 包 
括 我 们 这 里 考虑 的 非 完 整 移动 机 器 人 的 运动 学 模型 。 
我 们 将 分 别 在 用 三 维和 四 维 链 式 系统 建 模 的 独 轮 车 型 


任意 轨迹 都 是 非 增 的 ， 也 就 是 

y- -全 | Vi lz 
JERADARES ATES v, KATON, Aa, zk 
ATO, ZMR, WÈ v (t) =sint, 命题 成 立 ， 则 
z, KAF O0, JFH 


2) = 2 (0) + [o G)ds 


t 


=z (0) + |, sinsds 
=z (0) +1 - cost 
导致 z(t) TET EE z (0) +1 上 下 振动 。 为 了 减少 振 
动 ， 我们 可 以 向 v 乘 以 一 个 依赖 当前 状态 的 因子 。 
举 个 例子 来 说 ， 取 vv C, t) = lC, z) lsin, Ri 
再 补偿 一 个 像 -kz 一 样 的 镇 定 项 ， 其 中 %, >0， 即 
v,(z,t) = -kizi + || Cx ,zs) llsint 
所 以 我 们 得 到 的 这 个 反馈 控制 律 是 时 变 的 
定 的 。 
命题 34.9 
连续 时 变 反 馈 
v,(z,t) = -kizi +al(z, ,z) llsint 
p = -v (2,t) knz, - |.) es 
KPa, hy 4 >0， 使 得 三 维 链 式 系统 的 原点 为 全 
局 浙 近 稳定 1。 
上 述 的 命题 可 以 推广 到 任意 维 的 链 式 系统 *。 
对 于 n=4 的 情形 ， 也 就 是 对 应 着 轿车 型 车 辆 的 情形 ， 
我 们 有 如 下 的 结果 。 


是 渐 近 镇 


(34. 38) 


命题 34. 10 
连续 时 变 反 馈 
v, (z,t) = hz +a || (25.523,24 ) [sint 
Vv, (z,t) = |v, (z,t) | ky Z = (200) 


- |p, (z,t) |kyz, 
(34. 39) 
FUP, a, hs,34 2 0 WEPESI $us + 
kys + 如是 Hurwitz 稳定 的 ， 使 得 四 维 链 式 系统 的 原 
点 为 全 局 渐 近 稳定 。 
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图 34.9 展示 了 前 面 提 到 的 这 些 结果 。 在 这 个 仿 
真实 验 中 ， 反 馈 控制 规律 式 (34.39) 中 的 参数 a， 
kos TIREN a =3, 524; (1.2, 10, 18, 
17)。 图 34. 9a 显示 了 轿车 型 机 器 人 在 平面 上 的 运动 
过 程 。 在 上 =0 时 刻 的 最 初 的 形态 用 实 线 表 示 ， 而 期 
待 的 形态 用 虚线 表示 。 图 34. 9b 给 出 了 变量 x, y 和 0 
(对 应 于 模型 式 (34.5) 中 的 位 置 变量 与 方向 变量 ) 
的 时 间 演 变 过 程 。 


y 
2.5 


b) 


图 34.9 包含 利 普 希 茨 - 连续 控制 器 的 渐 近 镇 定 
a) 第 卡 儿 坐 标 系 下 的 运动 b) 误差 一 时 间 坐 标 系 


从 仿真 结果 可 以 清楚 地 看 到 ， 这 一 类 控制 的 一 个 
缺点 是 ， 系 统 状态 收敛 到 零 的 过 程 非常 缓慢 。 事 实 
上 ， 对 于 大 部 分 受 控 系 统 的 轨迹 ， 收 敛 速 率 仅仅 是 多 
项 式 级 的 ， 即 它 大 体 相 当 于 GO (常数 ae (0, 1))。 
这 个 缓慢 的 收敛 速率 与 一 个 事实 是 相关 的 ， 即 控制 函 
数 关 于 x 是 利 普 希 获 连续 的 。 此 类 系统 的 一 个 特征 就 


E 


命题 所 描述 。 

命题 34. 11 

考虑 控制 系统 = 让 (zx, u) (xe R", ue 
R”), dep f EMK, IFA (x, u) 2 (0, 0) 
是 该 系统 的 一 个 平衡 点 ， 假 设 这 个 系统 的 近似 线性 
系统 是 不 能 镇 定 的 。 仍 考虑 一 个 连续 的 时 变 反馈 
u(x, t), X-FRITRI :是 周期 的 ， 使 得 对 任意 时 间 t 
满足 u(0, t) = 0， 并 使 得 对 于 一 个 有 界 画 数 k, 
u(., D) ORT ABB x Eka) 利 普 希 茨 连 续 的 。 这 一 
反馈 不 能 保证 闭环 系统 的 解 一 致 指数 收敛 到 零点 : 
不 存在 常量 K > 0 和 7y »0, 使 得 沿 受 控 系 统 的 任 
一 轨迹 w*(. ) Mo 


læt) | SK |eCto) le "70 


(34. 40) 


这 个 不 可 能 性 的 直观 原因 可 以 在 独 轮 车 例子 中 被 
容易 地 证 明 。 当 使 用 链 式 系 统 描述 方式 时 ， 第 二 个 方 
FEJE Z, = 妃 2。 由 于 对 此 方程 在 (z = 0, v = 0) M 
近 的 线性 化 导致 2 =0， 系 统 的 近似 线性 系统 是 不 可 
控 的 〈 也 是 不 镇 定 的 ) 。 在 这 些 条 件 下 ， 当 应 用 一 个 
线性 反馈 时 ， 指 数 收敛 必然 使 增益 增长 到 无 限 ， 于 是 
超出 了 利 普 希 次 连续 特性 的 范围 。 基 于 这 个 原因 ， 并 
伴随 更 好 的 性 能 与 效率 的 需求 ， 推 动 了 连续 但 非 利 普 
希 菊 连 续 的 时 变 反馈 镇 定 技术 的 发 展 。 在 下 列 命题 中 
分 别 给 出 针对 三 维和 四 维 的 链 式 系统 的 此 类 反馈 的 例 
子 。 它 们 都 保证 了 一 致 指数 收敛 性 。 

命题 34. 12 

Ad a, kas > 0 使 得 多 项 式 p(s) 2s + 
hs +k, JJ Hurwitz 稳定 的 ， 对 任 一 整数 p, ge N”， 
4 p, ,表示 一 个 定义 于 RR “的 函数 ,满足 


Æ 


= 2 e cid py wale 
Vz, =(2,2,) €R°,p, (2%) = ( |z, om + |z, [9 Ye 
那么 ， FE qo >1 使 得 对 任意 q2quEp»q42, 如 
下 的 连续 状态 反馈 


V,(z,t) = —k, (z,sint — |z, |) sint + op, (z, ) sint 
vo(2,t) = - In Gu) NS 
23 
E imo (z,8) m z) 
(34.41) 
14 — HEBES, RSC UE TE, IP FE 


TE— BUR Bal Stc OU 


控制 规律 式 (34.38) 和 控制 规律 式 (34.41) 
之 间 的 继承 关系 是 显而易见 的 。 人 们 可 以 通过 验证 发 


是 该 类 系统 的 近似 线性 系统 并 非 是 能 镇 定 ， 正 如 下 面 


现 控 制 规律 式 (34.41) Æ z =0 处 有 定义 (由 连续 
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性 可 得 ) 。 更 精确 地 ， 两 个 比例 二 人- 和 一 人 在 
Pral) Pp,q (22) 


z, 7:0 处 有 定义 ， 并且 当 纪 趋 于 0 时 也 都 趋 于 0。 这 保 
证 了 控制 律 的 连续 性 。 

上 述 结果 中 指出 的 指数 收敛 特性 需要 进一步 的 解 
释 。 事实 上 ， 这 个 特性 并 不 完全 对 应 于 稳定 线性 系统 
的 经 典 指 数 收敛 性 。 在 后 一 种 情形 下 ， 指 数 收 敛 意味 
着 关系 式 (34. 40) 是 成 立 的 。 这 对 应 于 通常 的 指数 
稳定 概念 。 在 当前 的 情形 下 ， 这 个 不 等 式 变 为 

pLz(t)]<Kplz(to) ]e 7 

对 于 某 个 函数 p 成 立 ， 比 如 p 可 以 取 为 p(z) = |z | + 
p, CUm. 2), FE p, ,如 命题 34. 12 中 所 定义 。 尽 管 
函数 p 与 状态 向 量 的 欧 几 里 得 范 数 拥有 一 些 共同 的 特 
性 〈 正 定 的 且 当 ||z| 赵 向 于 无 穷 大 的 时 候 也 趋 于 无 穷 
X), ， 但 其 并 不 等 价 于 这 个 范 数 。 当 然 ， 这 并 不 能 改 
变 一 个 事实 ， 即 z 的 所 有 分 量 = 指数 收敛 到 零点 。 当 
然 ， 瞬 时 特性 是 不 同 的 ， 因 为 只 能 成 立 [z (0) |<K 
lz(4) Pe, HR rh a < 1， 而 不 能 成 立 
Iz, (t) |SK|lz(t)) lle 9 。 

在 四 维 链 式 系统 的 情形 下 ， 我 们 可 以 建立 如 下 结 
果 ， 其 类 似 于 命题 34. 12。 

命题 34. 13 

选 定 a, hy, >0 使 得 多 项 式 p(s) =s + 及 + 
has + k, de Hurwitz 稳定 的 。 对 于 任意 整数 p,，g es 
N^, EXER? ”上 的 函数 p,,， 满 足 


p p ANI 
Ppa (32) = C |a; odas aste ect PE 
XB, Py, e 2 £n) eR, 那么 ， 存在 q >1 

使 得 qzqy E. p»q-42, WU FIXES Sx iit 


V, (z,t) = —k, (z, sint — Iz, | ) sint + ap, (z, ) sint 
nno - InG0 licet on Gk s 
= Iv, (z,t) om 
(34.42) 
使 得 四 维 链 式 系统 的 原点 是 全 局 渐 近 稳定 的 ， 并 存 


在 一 致 指数 收敛 速率 。 


图 34. 10 中 所 示 的 仿真 结果 验证 了 控制 规律 式 
(34.42) 的 性 能 。 控 制 参数 如 下 : a =0.6, 和 ,34 = 
(1.6, 10, 18, 17), q-22, p-5, A 34. 9 所 示 的 
结果 相 比较 ， 可 知性 能 有 了 明显 的 提升 。 


2. 混合 反馈 


这 些 反 馈 构成 了 对 固定 位 姿 的 渐 近 镇 定 的 可 替代 
选择 。 通 常情 形 下 ， 对 状态 的 依赖 对 应 于 周期 性 的 更 


b) 


图 34. 10 连续 (菲利普 希 茨 ) 时 变 反馈 的 渐 近 镇 定 
a) 第 卡 儿 坐标 系 下 的 运动 b) 误差 一 时 间 坐 标 系 


新 〈 不 同 于 时 变 反馈 的 连续 更 新 ) ， 在 此 意义 上 ， 混 
合 反馈 可 以 看 作 开 环 控制 和 反馈 控制 的 一 种 混合 。 在 
两 个 更 新 之 间 ， 控 制 律 引入 到 开 环 模式 。 但 是 ， 这 种 
类 型 的 控制 可 能 会 出 现 一 些 针 对 时 变 反 馈 的 优点 。 这 
一 点 会 在 稍 后 做 一 个 简要 的 说 明 。 以 下 命题 可 以 作为 
混合 反馈 的 一 个 示例 。 
命题 34. 14 
混合 反馈 控制 律 v 定义 如 下 : 
v(t) 2v[z(kT) t], Vte (AT, (k € 1)T] 

(34. 43) 


Erp 


P, (2,1) = ar EC, 1) +2mp(2) sin( wt) ] 


N 


5G =| Gs -Dzs 6205 - D rest | 
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k 4€ (-1,1),0 = 乞 
p(z) =a, |z |? , (œ, >0) 
此 控制 律 是 一 个 针对 三 维 链 式 系统 的 K(7T) - 指 
LU Vr M 
上 面 命 题 中 所 提 到 的 K(7) -指数 镇 定 器 是 指 
存在 正常 量 K,， m 和 y， 其 中 y <1， 使 得 对 于 任意 的 
z0， 受 控 系 统 从 t=0 时 刻 的 初始 值 a。 出发， 到 达 时 
刻 t 时 的 解 ， 记 为 z(1:，0，zo)， 满足 对 任意 的 keN 
和 任意 se [0，7) ， 如 下 不 等 式 成 立 
|z( Ck 1) 7,0,2,) [I y la CKT,O ,zo) || 


[zCCET 8 5,0,2,) || <K||z(AT,0,z,) |” a) 
这 些 关系 式 表 明 对 系统 轨迹 指数 收敛 到 原点 z = (Gub 
0。 但 它们 不 能 表明 原点 的 稳定 性 ， 因 为 |z (KT, 0, 2 
zy) | 在 某 时 刻 1=z 可 能 为 0， 而 且 在 那 之 后 就 不 能 || an 由 : 
保持 为 0。 然 而 ,注意 到 如 果 对 某 些 ke N 有 — 
lz (AT, 0, zo) 上 =0， 则 以 上 的 关系 可 以 表明 对 所 有 Tr 
t2SkT, Allz (1, 0, z,)]|20. ae 
对 于 四 维 的 系统 ， 可 以 得 到 类 似 命题 34. 14 的 | 
结果 。 0 a 
命题 34. 15 i 
混合 反馈 定律 v 定义 如 下 : 
v(t) 2v[z(kT) t] , VtielkT,(k+1)7] 10 20 30 40 50 60 70 80 
(34. 44) 
其 中 E 


图 34. 11 混合 离散 /连续 控制 器 的 渐 近 镇 定 
a) 笛 卡 儿 坐 标 系 下 的 运动 b) 误差 一 时 间 坐标 系 


D(z,t) = 于 | 220252 5010 


Z5 
p(z) 始终 是 一 个 重要 的 问题 。 事 实 上 ， 如 果 不 是 为 了 角 棱 
cosut) +8( 有 -Deos(2oD | 性 ， 反 馈 控 制 将 会 失去 它 相对 于 开 环 控制 解决 方案 的 
p (2) 价值 和 意义 。 一 般 会 存在 多 种 鲁 棒 性 问题 ， 其 中 有 一 
hasse C 1,1), =F, p(z) =a |2 a, ”类 问题 关心 对 建 模 误差 的 敏感 度 。 例 如 ， 考 虑 一 个 独 
ead e 轮 车 型 机 器 人 ， 它 的 运动 学 方程 为 X& = u,b, (x) ub 
oo S ， 我 们 想 知道 一 个 可 以 镇 定 这 种 系统 的 平衡 点 的 
At KCT) - 指数 镇 定 器 “”。 反馈 控制 律 是 否 也 可 以 镇 定 它 的 邻居 系统 的 平衡 点 ， 
应 用 反馈 定律 式 (34. 44) 的 仿真 结果 如 图 34. 11 。 其 邻居 系统 的 运动 学 方程 为 =u lb, (x) + eg (x) ] 
所 示 。 具 体 控制 参数 取 为 7 =3, hi, = 0.25， +u [b (x) +eg,(x)], HP g Al g WER AR, m 
参数 s 用 来 度量 建 模 误差 。 这 类 误差 是 可 以 计算 的 ， 


" =L (h —1)z +27p(z)sin(at) ] 


[e + 


a, 3 =0.95。 控 制 性 能 和 图 34. 10 中 所 示意 的 相 类 似 ， 
因为 两 个 控制 律 都 保证 了 指数 收敛 到 原点 。 


34.4.5” 非 完整 约束 系统 控制 的 固有 局 限 性 
我 们 首先 指出 上 面 提 到 的 非 线性 时 变 反 馈 和 混合 


反馈 所 存在 的 一 些 问 题 。 


当 研究 反馈 控制 时 ， 重 棒 性 


例如 ， 驱 动 轮轴 的 方向 相对 于 底座 会 有 一 个 很 小 的 不 


确定 性 ， 这 将 导致 在 方向 测量 上 出 现 


PE. 对 某 些 特 


定 函 数 g All g, 和 任意 小 的 <， 我 们 可 以 证 明 类 似 式 
(34. 41). 那样 的 时 变 控制 律 对 这 类 建 模 误 差 是 没有 
鲁 棒 性 的 ， 即 系统 的 解 将 最 终 在 原点 的 附近 震荡 而 不 
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是 收敛 到 原点 。 换 言 之 ， 即 使 在 没有 任何 测量 噪声 的 
情形 下 ， 任 意 小 的 一 个 建 模 误差 都 将 会 破坏 掉 原点 的 
稳定 性 和 原点 的 收敛 性 。 在 这 一 方面 ， 混 合 控 制 规律 
st (34.43) 的 鲁 棒 性 更 好 : 不 论 多 么 小 的 =。， 受 控 
系统 的 解 都 将 指数 收敛 到 原点 。 但 是 ， 一 个 最 轻微 的 
离散 化 不 确定 性 将 导致 同样 的 局 部 不 稳定 性 。 考 虑 到 
这 些 问 题 ， 我 们 会 提出 疑问 ， 是 否 存在 具有 重 棒 性 的 
快速 (指数 ) 镇 定 控制 器 ， 就 像 那 些 镇 定 线性 系统 
的 线性 反馈 控制 器 一 样 。 据 我 们 所 知 ， 问 题 的 答案 是 
这 样 的 控制 解决 方案 (不 论 连 续 的 还 是 不 连续 的 ) 
还 没有 被 发 现 。 对 于 非 完整 系统 来 说 ， 问 题 更 是 如 
此 。 针 对 建 模 误差 、 控 制 离散 化 和 时 延 的 稳定 性 的 鲁 
棒 性 已 经 在 某 些 情形 下 被 证 明了 ,但 是 只 有 在 利 普 希 
茨 连 续 反馈 的 情形 下 才能 获得 。 此 时 ， 我 们 已 经 看 
到 ， 可 以 保证 慢 速 的 收敛 。 鲁 棒 性 和 性 能 之 间 的 折 中 
看 起 来 要 比 镇 定 的 线性 系统 (或 者 非 线 性 系统 的 线 
性 近似 系统 是 镇 定 的 ) 的 情形 更 糟糕 。 

另 一 个 问题 是 已 经 证 明 不 存在 一 个 普 适 的 反馈 控 
制 器 可 以 渐 近 镇 定 任何 可 行 的 参考 状态 路 径 ' 关 7 。 这 
是 另 一 个 显著 不 同 于 线性 系统 的 地 方 。 事 实 上 ， 给 定 
的 一 个 能 控 的 线性 系统 = Ax + Bu， 其 反馈 控制 器 
u=u,+K(x -x,)， 其 中 KK 是 增益 矩阵 ,使 得 A + BK 
是 Hurwitz 稳定 的 。 它 可 以 指数 镇 定 在 相应 的 系统 输 
入 uw, 下 任意 可 行 的 参考 轨迹 x，( 系统 的 解 )。 对 于 非 
完整 移动 机 器 人 情形 ， 这 样 的 控制 器 不 存在 ， 和 之 前 
那些 考虑 轨迹 镇 定 的 命题 (命题 34.4 和 命题 34. 5) 
中 提 到 的 关于 纵向 速度 的 条 件 是 有 一 定 关系 的 。 这 从 
根本 上 表明 ， 这 些 条 件 不 能 被 完全 去 掉 : 不 管 我 们 选 
择 什 么 样 的 反馈 控制 器 ， 总 是 存在 一 条 反馈 控制 器 不 
能 渐 近 镇 定 的 可 行 参 考 路 径 。 注 意 这 种 限制 在 非 标准 
反馈 〈 例 如 时 变 周 期 反馈 ， 其 可 以 渐 近 镇 定 收缩 到 
一 点 的 参考 路 径 ) 中 也 会 存在 。 进 一 步 ， 这 种 限制 
有 着 明显 的 工程 意义 ， 因 为 存在 这 样 的 实际 应 用 
(比如 自动 跟踪 一 辆 由 人 驾驶 的 汽车 ) ， 其 参考 路 径 
和 它 的 性 质 事 先是 未 知 的 (领航 的 车 将 要 停 下 来 还 
是 要 继续 走 ?) 。 这 导致 我 们 不 能 轻松 决定 该 使 用 哪 
个 控制 器 。 在 很 多 的 控制 器 之 间 切 换 是 个 合理 的 策 
略 ， 这 已 经 被 一 些 人 研究 过 了 ， 并 且 在 很 多 情形 下 都 
能 找到 理想 的 解决 方案 。 然 而 ， 由 于 执行 预先 设 定 两 
个 控制 器 之 间 的 切换 策略 可 以 归结 为 设计 第 三 种 控制 
器 ， 这 有 既 不 能 解决 问题 的 核心 ， 也 不 能 保证 绝对 的 
成 功 。 

第 三 个 问题 并 非特 别针 对 非 完 整 约束 系统 ， 但 是 
在 非 线性 控制 文献 中 很 少 提 及 ， 其 关注 的 是 不 可 行 轨 
迹 的 跟踪 问题 ( 即 不 是 系统 方程 解 的 轨迹 )。 由 于 精 


确 跟 踪 是 不 可 能 的 ， 根 据 不 可 行 轨迹 的 定义 ， 控 制 目 
标 是 保证 该 跟踪 误差 缩小 到 某 些 非 零 闪 值 之 内 并 一 直 
保持 不 再 超出 。 在 非 完整 约束 系统 情形 下 ， 如 果 速 度 
控制 输入 的 幅 值 没有 限制 ,那么 这 些 闵 值 中 理论 上 可 
以 任意 小 。 这 一 事实 使 得 这 个 问题 与 这 些 系 统 关系 更 
紧密 。 这 可 以 称 为 实用 镇 定 目标 ， 虽 然 它 比 前 面 章节 
中 考虑 的 镇 定 目标 稍 弱 ， 但 是 极 大 地 拓宽 了 控制 设计 
问题 和 应 用 范围 。 例 如 ， 它 可 以 描述 用 一 个 独 轮 车 型 
车 辆 或 者 轿车 型 车 辆 跟踪 一 个 全 方向 型 车 辆 的 轨迹 问 
题 。 在 考虑 避 障 的 轨迹 规划 中 ， 针 对 一 类 移动 机 顺 
人 ， 把 不 可 行 轨迹 转化 为 可 行 轨迹 可 以 通过 应 用 实用 
镇 定 控 制 器 于 此 类 机 絮 人 的 模型 上 对 系统 的 闭环 方程 
进行 数值 积分 来 实现 。 此 外 ， 如 果 我 们 用 实用 镇 定 目 
标 代替 渐 近 镇 定 目 标 ， 对 前 面 提 到 的 那个 普 适 镇 定 控 
制 器 的 存在 问题 进行 重新 表述 ， 那 么 答案 就 会 变 为 肯 
定 的 : 如 此 的 镇 定 控制 器 存在 ， 并 且 参 考 轨迹 不 必要 
求 可 行 。 

34.4.6 ”基于 横 截 函数 方法 的 任意 轨迹 的 实 

用 镇 定 


针对 能 控 无 漂移 系统 ， 参 考 文献 [34.8] 描述 
了 一 种 设计 实用 镇 定 器 的 可 能 的 方法 。 我 们 接 下 来 回 
顾 其 中 一 些 基 本 的 原理 。 然 后 把 它们 改编 到 独 轮 车 型 
和 轿车 型 移动 机 器 人 的 例子 上 。 

我 们 首先 介绍 一 些 本 节 将 要 用 到 的 矩阵 符号 。 


cosÜ -sin 0 -1 
i z ( 1 Js - | | 
sinÜ | cos0 1 0 
RCO) ia 1) 


0 1 
1. 独 轮 车 型 情形 
根据 如 上 的 符号 ， 
写 为 


动力 学 模型 式 (34.4) 可 以 
£-R(0)Cu (34.45) 


1 0 
AU, g - (x, "E 6)", C= ° | 我 们 考虑 一 个 
0 1 


平滑 函数 
f. Ca) 
fra Pla) =| f (a) 
(a) 


tH, aeS'=R/20Z ( 即 a 是 一 个 角度 标量 ) 并 


e [rots 
0 
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x f. (o) 
NEL f(a) 


(34. 46) 
0 —fy( a) 
注意 有 可 以 看 做 坐标 系 正 Ca) 的 一 种 状态 ， 其 
原点 在 坐标 系 Fa 中 的 位 置 为 - R( MADE 
y Q 


FI JU REE, ALTE SE(2) 中 李 群 运算 
的 意义 下 g Sf (a) ”的 积 。 由 于 f(a) 的 元 素 都 小 ， 
因此 F(a) 无 限 欧 近 Fo 对 任意 平滑 时 间 函 数 t I9 
a(t), Eo teu 0 
数 如 下 给 ! 


g-R(0)u (34. 47) 
式 中 
— Cu 
u -A(a) (R(f,(a)) -8f/9a(a) Y . 
à 


(34.48) 


Á fe) 

A(a)=| - (a) (34. 49) 
0 1 

由 式 (34.47) 和 式 (34.48) ， 我 们 可 以 把 c 看 做 一 
种 补偿 控制 输入 ， 其 可 以 用 于 监控 坐标 系 互 (a) 的 
移动 。 更 精确 地 , F(a) 可 以 看 做 是 全 方位 坐标 系 ， 
Ea 可 以 等 于 任何 R ”中 的 向 量 ， 即 ， 只 要 映射 


(u, a)ou 是 映 上 的 。 下 面 我 们 确定 何 时 这 个 条 件 
可 以 得 到 满足 。 方 程式 (34.48) 也 可 以 写成 


ZUM (34. 50) 
其 中 
cosf,(a) 0 —af./aa(a) 
H(a) =| sinf,(a) 0 -af,/da(a) 
0 1 -daf,/da(a) 
(34. 51) 


由 于 4(a) RN), Fla) 是 全 向 的 当 且 仅 
MÓBEEH(a) 也 是 可 逆 的 。 如 果 一 个 函数 上 对 任意 
a eS' 都 满足 这 个 性 质 ， 则 称 其 为 一 个 横 截 函数 *1。 
此 类 函数 的 存在 性 的 问题 已 经 在 更 广泛 的 横 截 函数 方 
法 意义 下 得 到 了 讨论 "2 。 在 当前 的 例子 中 ， 一 个 
横 截 函数 族 给 出 如 下 : 


esing 


LE 


2 sinda 


f(a)=|en 4 


&,9 »0 (34.52) 


arctan( e7cosa ) 


lll 


有 实 上 ， 利 用 这 个 函数 ， 我 们 可 以 证 明 ， 对 任意 


detH (a) = P 


cos ( arctan ( £ycosa ) ) < 0, 


请 注意 ， 当 se 趋向 于 零 时 ， 函 数 f 的 所 有 分 量 一 致 趋 
向 于 零 。 因 此 ， 通 过 选择 足够 小 (但 是 不 等 于 零 ) 
的 s， 相 应 的 全 方位 坐标 系 F(a) 可 以 任意 地 接 
it Fao 
现在 , St Pga) [x (D, y(t), 60017 
一 条 光滑 但 是 任意 的 参考 轨迹 。 从 式 (34.47) 不 
bo ARRE u, 其 在 g, 时 渐 近 镇 定 g. 
一 种 可 能 的 选择 是 
z=R(-0)[g-k(g-g.)] (34.53) 
RERA (g-g)- -k(g-g.)2. KIE, TER k 
>0, g-g, =0 是 如 上 方程 的 一 个 指数 稳定 的 平衡 
点 。 于 是 ， 由 式 (34.46) 可 以 得 到 
Jim {g(t) -g, (0) -RLO lal) ]}=0 
(34. 54) 
跟踪 误差 lg -g, 的 范 数 最 终 由 f(a) 的 范 数 界 
定 。 根 据 式 (34. 52) ， 通 过 选择 合适 的 a， f(a) We 
数 可 以 任意 的 小 。 在 这 个 意义 上 可 以 获得 实用 镇 定 。 
针对 独 轮 车 型 机 器 人 的 控制 二 可 以 通过 关系 式 
(34.50) WRM u HIRIK (34.53) 计算 得 到 。 
为 获得 一 个 好 的 跟踪 精度 ， 可 以 采用 非常 小 的 e 
值 去 得 到 横 截 函数 /但 我 们 必须 认识 到 这 个 策略 的 
局 限 性 。 实 际 上 ， 当 s 趋向 于 零 ， 式 (34.51) 定义 
的 矩阵 五 (a ) 会 变 成 病态 ， 它 的 行列 式 趋 向 于 零 。 根 
据 式 (34.50) ， 这 意味 着 机 右 人 的 速度 u, Alu, 会 变 
得 非常 大 。 特 别 是 ， 当 参考 轨迹 g, AUTH, RE 
动作 都 有 可 能 发 生 。 我 们 注意 到 对 于 机 器 人 的 非 完 整 
性 ， 这 个 困难 是 固有 的 ， 而 且 也 不 能 被 规避 (考虑 
把 车 停 在 一 个 非常 罕 的 停车 位 上 这 样 一 个 问题 ) 。 出 
于 这 个 原因 ， 试 图 在 不 可 行 的 轨迹 上 实现 非常 精确 的 
轨迹 跟踪 在 实践 中 不 是 一 个 很 好 的 选择 。 另 一 方面 ， 
当 轨 迹 是 可 行 的 ， 不 需要 过 多 动作 实现 精确 跟踪 ， 在 
这 种 情形 下 可 以 使 用 较 小 的 e 值 。 
这 样 很 明显 就 导致 了 一 个 两 难 的 局 面 ， 当 参考 轨 
迹 不 是 事先 可 知 的 ， 且 它 的 可 行 性 特征 会 随时 间 而 变 
化 。 在 参考 文献 [34. 10] 中 提出 了 一 个 解决 这 个 问 
题 的 控制 策略 ， 其 基于 在 线 调节 横 截 函数 的 大 小 。 目 
前 这 个 方法 在 独 轮机 器 人 上 的 实验 验证 可 在 参考 文献 
[34. 11] 中 找到 。 
2. 轿车 型 
上 面 提 到 的 控制 方法 可 以 推广 到 轿车 型 车 辆 上 
(同样 也 可 以 推广 到 带 拖车 的 情形 ) 。 同 样 ， 思 路 是 


1 
aes, 
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给 机 器 人 坐标 系 FRE M M e RE RELAIS AR. Fn (a)， 
其 通过 选择 一 些 设计 参数 可 任意 接近 f,。 下 面 我 们 
看 看 它 是 如 何在 轿车 型 车 辆 上 实现 的 ， 为 简化 后 面 的 
方程 ， 可 以 将 系统 式 (34.5) 改写 为 


X =LICOosO 


y =u sin 
Ó -u,é 
é =u, 
sh, é=tand/L, ue =u (1 +tan” 中 )/L。 该 系统 也 可 
表示 为 (对 照 (34.45)) 
[ =R(0)C(E)u, 
=u; 
式 中 , g=(x, y, 0)", CE) 80, 0, £". 我们 下 
面 考虑 一 个 平滑 函数 


(34.55) 


AS 
(CRM E 

ahh x 上 
PEE" tals) | pecan 
nS 


式 中 ， aeS xS! (EI a= (œ, a,)), 我 们 定义 
(对 照 (34. 46)) 


} =g - R(6- f, (0) f, (0) 


es (34. 56) 
x (a 
PEE e) 
0 - f, (a) 
类 似 于 独 轮 车 型 的 情形 ， 其 可 以 看 作 某 个 对 照 坐 标 系 
F(a) 的 一 种 状态 ， 对 计算 沿 着 任意 时 间 平 滑 函 
Ht Malt) 和 系统 式 (34.55) 任意 解 的 微分 ， 可 
以 确定 式 (34.47) 依然 成 立 ， 除 了 到 被 表示 为 
z=A(a) (R[f, (a) ] - af,/de, (a) - 
C(£)u, 
af, /da,(a)) x | a, 


ve 
I 
œ SI RI 


(34. 57) 


a> 
而 不 是 像 式 (34.48) 定义 的 那样 (A (a) 仍 由 式 
(34.39) 所 定义 )。 由 于 
C(£)u, 2 C(f;(a))u, +{C(E) -Clfi(a) ] hu 


1 0 
1 0 四 0 p 
(a) &-fi(q) 


式 (34.57) 可 以 改写 为 


Ul 0 
N=A(a)H(a) | ZI 0 | 
à, u,lé—f,( a) ] 
(34. 58) 
式 中 
cosf,(a) -əf/ða (a) -əðf/ða, (a) 
H(a) =| sinf,(a) -öf/ða (a) -əf /ða, (a) 
fa) -óf/9a,(a) -əf,/ða, (a) 
(34. 59) 
令 ug=f g(a) -KE-fe(a)) (34.60) 


~ 

其 中 >0， 由 式 (34.45) 可 知 &-f.(a) 指数 收敛 
到 0。 因 此 ， 经 过 短暂 的 相位 (其 持续 时 间 可 由 1/k 
所 度量 ) a, RINAE-f.(a) ~0, Ast (34.58) 
可 以 简化 为 : 


H 


uy 


ü -A(a)H(a) à, (34. 61) 


Q2 

(EPR Lf fS (a) 始终 可 逆 ， 这 也 就 意味 着 与 
g 相关 的 坐标 系 F, (o) 是 全 向 的 。 所 有 满足 这 个 性 质 
的 函数 称 为 横 截 函数 。 一 旦 这 个 确立 了 ,我们 可 以 渐 
近 镇 定 世 的 任意 参考 轨迹 &， 例 如 ,定义 五 如 式 
(34.45), ， 车 辆 所 需 的 控制 律 u, 可 以 通过 对 式 (34. 61) 
的 求 逆 获得 。 下 面 的 引 理 描述 了 一 个 横 截 函数 的 集合 : 

引 理 34. 1 

对 于 任意 的 a>0 和 ,ms， m, Em, m, 
n, >0, H6n,n, 589, * 9,9, PARC f sg CHE: 


fi(a) 
Jala) 
arctan( f, (a) ) 
f; Ca) cosè f, (a) 
sth, f: SixS'oOR*H FRA H: 


e( sina; +m sina, ) 


fla) = 


£1], Cosa’, 
i (a) = e p -coson ) 
3 ( sin o, cose, 7; 8in2a, : ) 
€ 1 = m2 13 sing, cosa 
6 4 
则 满足 横 截 条 件 : det (a) 40Va, HH H(o) 


Fst (34.59) fpe WU. 
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图 34. 12 中 的 仿真 结果 表明 了 控制 方法 对 一 个 轿 
车 型 机 器 人 的 应 用 。 参 考 轨迹 是 由 初始 条 件 g, (0) = 
0 和 它 如 下 的 时 间 导 函数 决定 

(0,0,0)" 
(1,0,00* te 


te [0,30] 
30 ,38 


( -1,0,0)* 
(0,0,0.2)" 


te [53,61 
te [61,80 


[ 
[ 
é. (t) =4(0,0.3,0)" te [38,53 
[ 
[ 


] 
] 
] 
] 


VARA 


图 34. 12 采用 横 截 函数 方法 的 任意 轨 线 的 实用 镇 定 
a) 第 卡 儿 坐 标 系 下 的 运动 b) 误差 一 时 间 坐 标 系 


S. e[0, 30] 时 ， 对 应 于 一 个 固定 位 姿 ， 当 4 e 
[31, 61] 时 ， 按 时 间 顺 序 描述 了 三 种 纯粹 的 平移 运 
动 ; 41 e[61, 80] 时 ,描述 了 一 种 纯粹 的 旋转 运 
By, FATTER t e[38, 53] 时 ， 对 轿车 型 机 器 
人 来 说 参考 轨迹 是 不 可 行 的 ， 因 为 对 应 于 一 个 与 g, 相 
关 的 坐标 系 F, 下 单位 向 量 广 的 方向 上 的 侧 向 平移 ; 
同样 当 上 e[61, 80] 时 ， 参 考 轨 线 也 是 不 可 行 的 ， 
因为 一 个 后 轮 驱 动 的 车 辆 是 不 能 做 纯粹 的 旋转 运动 。 


轿车 型 机 器 人 在 上 = 0 时 ,初始 状态 为 g(0) = (0, 
1.5，0) ， 初 始 方向 角 为 w(0) =0 。 

在 图 34. 12 a 中 ， 用 实 线 框 表示 不 同时 刻 机 器 人 
的 位 姿 ， 用 虚线 框 表示 在 对 应 时 刻 参 考 机 器 人 底座 的 
位 姿 。 图 中 同样 反映 了 机 器 人 两 个 后 轮 轮轴 中 心 的 运 
动 轨迹 。 图 34. 12 b 给 出 了 在 参考 坐标 系 (BM (x, 
y.) 由 式 (34.20) 所 定义 ，0. =0 -0.) 下 跟踪 误差 
随时 间 变 化 的 过 程 。 由 式 (34.54) "IA, 在 8 指数 
WHEE ASG, |x|, ly. | 和 |9. | 的 最 终 上 界 分 
别 由 函数 六 ,，f. 和 所 的 最 大 振幅 所 决定 。 在 这 个 仿真 
实验 中 ,， 引 理 34. 1 中 横 截 函数 的 控制 参数 取 以 下 数 
fi: £20.17, ”1s3 = (12，2，20)。 基 于 这 些 具 体 
数值 ， 我 们 可 以 验证 |f. |. LA, | 和 |f | 的 上 界 分 别 为 
0.51, 0. 11 和 0.6。 这 与 图 中 所 示 的 跟踪 误差 的 时 间 
演化 相 一 致 。 正 如 对 独 轮 车 型 情形 所 指出 的 ， 我 们 可 
以 通过 减 小 e 的 值 来 获得 更 高 的 跟踪 精度 ， 但 是 这 将 
导致 更 大 的 控制 输入 值 以 及 更 频繁 的 动作 ， 特 别 是 在 
时 间 区 间 [38, 53] 和 [61, 80] 内 ， 此 时 参考 轨 
线 是 不 可 行 的 。 


34.5 补充 材料 和 参考 文献 指南 


1. 广义 拖车 系统 

这 里 所 提出 的 大 部 分 针对 独 轮 车 型 机 器 人 和 轿车 
型 机 器 人 的 控制 设计 方法 都 可 以 推广 到 由 一 个 领航 车 
辆 拖 着 多 节 拖 车 的 火车 型 机 器 人 的 情形 。 特 别 地 ， 第 
34. 4 节 中 针对 非 完 整 系统 所 提出 的 方法 都 可 以 推广 
到 这 个 情形 ， 只 要 通过 把 描述 系统 的 运动 的 运动 学 方 
程 组 转换 成 (至 少 半 全 局 地 ) 一 个 链 式 系统 即 
可 尼 引 。 为 此 ,一 个 基本 的 前 提 是 每 一 节 拖 车 都 要 链 
接 在 前 一 节 车 辆 后 轮 的 轮轴 上 ”。 例 如 ， 当 有 两 
节 (或 更 多 节 ) 相继 的 拖车 采用 非 轴 点 的 链接 ， 则 
向 链 式 系统 的 转换 是 无 法 实现 的 外。 所 谓 的 广义 
拖车 系统 (包括 采用 非 轴 点 的 链接 ) 导致 了 更 加 困 
难 的 控制 设计 问题 ， 并 且 关 注 此 类 问题 的 文献 也 很 
少 。 基 于 这 个 原因 ， 再 加 上 由 于 这 些 系统 远 没 有 简单 
的 车 辆 那么 高 的 应 用 频率 ， 在 这 里 我 们 就 不 再 单独 阐 
述 那些 针对 此 类 问题 的 控制 方法 了 。 不 过 ， 一 部 分 相 
关 的 参考 文献 会 在 下 面 列举 。 路 径 跟 随 问题 已 经 被 充 
分 地 考虑 了 ， 比 如 在 参考 文献 [34.15] 中 讨论 了 包 
含 两 节 拖 车 的 系统 更 一 般 地 ， 在 参考 文献 
[34.16] 的 第 3 章 和 参考 文献 [34.17] 中 讨论 了 包 
含 任意 多 节 拖 车 的 系统 。 据 我 们 所 知 ， 针 对 此 类 系统 
的 镇 定 非 静 态 的 参考 轨迹 还 没有 结果 (除了 单 拖 车 
情形 ， 此 时 系统 可 以 转变 为 链 式 形式 “1 ) 。 实 际 
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上 ， 明 确 地 求解 从 一 任意 位 姿 到 另 一 任意 位 姿 的 可 行 
轨迹 已 经 是 一 个 极端 困难 的 问题 ， 即 使 在 没有 考虑 障 
碍 物 的 情形 下 。 而 对 于 一 大 类 可 控 无 漂移 系统 的 固定 
位 姿 渐 近 镇 定 问题 ， 则 可 以 〈 在 理论 上 ) 应 用 很 多 
现 有 的 一 般 性 方法 得 到 解决 。 然 而 ， 与 这 些 方法 相关 
联 的 计算 会 随 着 拖车 数量 的 增加 而 很 快 会 变 得 难以 处 
理 。 一 些 更 特殊 和 更 简单 的 问题 已 经 有 所 讨论 。 在 参 
考 文献 [34. 19] 中 讨论 了 针对 任意 节 数 的 拖车 和 简 
化 的 位 姿 集 的 渐 近 镇 定 。 在 参考 文献 [34.20] rh, 
讨论 了 包含 两 节 拖车 和 任意 固定 位 姿 的 情形 。 

2. 基于 传感器 的 运动 控制 

在 本 章 中 所 描述 的 控制 律 以 及 相应 的 计算 , 包 
括 在 线 测量 ， 最 终 都 需要 对 车 辆 所 在 环境 中 与 车 辆 
位 置 相关 的 一 些 变 量 的 在 线 估计 作为 补充 。 这 些 测 
量 通过 应 用 以 下 各 种 传感器 CUE. GPS, AE 
计 、 视 觉 等 ) 获得 。 通 常 ， 在 计算 控制 变量 自身 之 
前 ， 首 先 要 用 多 种 方法 对 传感器 的 原始 数据 进行 处 
理 。 例 如 ， 噪 声 滤 波 和 状态 估计 都 是 此 类 的 基本 操 
作 ， 这 些 都 在 自动 控制 类 文献 中 非常 常见 。 在 所 有 
的 传感器 中 ， 视 觉 传感器 在 机 器 人 应 用 中 扮演 着 一 
个 非常 重要 的 角色 。 这 是 由 于 视觉 传感器 可 以 提供 
丰富 多 彩 的 信息 。 把 视觉 数据 和 反馈 控制 结合 在 
起 ， 经 常 称 为 视觉 伺服 。 在 第 24 章 里 ， 给 出 了 若干 
视觉 伺服 任务 ， 主 要 是 对 操作 的 情形 ， 和 /或 假设 机 
器 人 任务 的 实现 等 价 于 控制 安装 在 全 方位 操作 手 上 
的 摄像 机 位 姿 的 情形 。 在 一 些 情形 下 ， 本 章 所 描述 
的 概念 和 方法 可 以 毫 不 费力 地 适用 于 移动 机 器 人 的 
情形 。 这 些 情形 基本 上 对 应 于 在 本 章 的 第 34. 3 节 所 
描述 的 从 机 器 人 操纵 改编 而 来 的 控制 方法 。 例 如 ， 
通过 控制 机 器 人 车 体 侧面 和 道路 边缘 之 间 视 觉 估 计 
的 距离 来 实现 的 自动 驾驶 ， 或 者 通过 控制 机 器 人 车 
体 与 领航 车 体 前 方 和 侧 方 的 距离 来 实现 的 车 辆 编队 。 
这 些 问 题 可 以 应 用 第 24 章 给 出 的 控制 技术 进行 讨 
论 。 原 因 是 可 以 比较 容易 地 把 这 些 技术 改造 为 在 第 
34.3 节 所 给 出 的 控制 方法 。 然 而 ， 也 存在 一 些 针对 
非 完整 移动 机 需 人 的 基于 视觉 的 实际 应 用 问题 ， 它 
们 是 不 能 通过 应 用 经 典 视觉 伺服 技术 解决 的 。 例 如 
像 这 种 情形 : 在 第 34. 4 节 所 描述 的 任务 目标 中 ， 把 
非 完整 车 辆 的 完整 位 姿 (即位 置 和 方向 ) 镇 定 到 一 
个 期 望 位 姿 处 。 基 于 视觉 控制 的 此 类 问题 在 参考 文 
献 [34.10, 21] 中 进行 了 讨论 。 

较 早 之 前 已 经 发 表 了 一 些 关 于 轮 式 移动 机 器 人 控 
制 的 研究 综述 。 如 参考 文献 [34. 22-24] 讨论 了 建 
模 和 控制 问题 。 参 考 文献 [34.25] 针对 不 同类 型 的 
轮 式 移 动机 器 人 结构 ， 对 运动 学 和 动力 学 模型 进行 了 


详细 的 分 类 ， 这 是 第 17 章 的 基础 。 利 用 链 式 形 式 来 
描述 轮 式 移动 机 器 人 方程 是 在 参考 文献 [34.26] 提 
出 讨论 的 ， 并 在 参考 文献 [34. 13] 中 进行 了 推广 。 

路 径 跟 随 可 能 是 研究 人 员 在 机 器 人 学 领域 提出 来 
的 第 一 个 移动 机 器 人 控制 问题 。 从 前 人 工作 中 ， 我 们 
挑选 了 参考 文献 [34.27，28 ] 。 若 干 在 本 章 中 所 介 
绍 的 结果 源 于 参考 文献 [34.5, 29], 

针对 独 轮 车 型 和 轿车 型 机 器 人 的 跟踪 可 行 轨 迹 问 
题 在 参考 文献 [34.22-24] 中 有 所 体现 ， 当 然 也 出 
现在 大 量 的 会 议和 期 刊 论文 中 。 若 干 学 者 通过 应 用 动 
态 反 馈线 性 化 技术 讨论 了 这 些 问题 。 在 这 方面 ， 例 如 
可 以 见 参考 文献 [34.30-32] 和 参考 文献 [34. 22 ] 
的 第 8 章 。 

在 固定 位 姿 的 渐 近 镇 定 问 题 上 ， 已 经 发 表 了 很 多 
论文 。 其 中 ， 参 考 文献 [34.33] 给 出 了 一 个 早期 的 
反馈 控制 技术 方面 的 综述 ， 以 及 相关 的 参考 文献 。 针 
对 独 轮 车 型 机 器 人 ， 参 考 文献 [34.3] 给 出 了 第 一 
个 用 时 变 反 馈 描述 的 控制 律 。 会 议论 文 [34.34] 综 
述 了 针对 更 一 般 的 非 线 性 控制 系统 的 时 变 反 馈 镇 定 。 
更 详细 的 结果 ， 类 似 命题 34. 9 和 命题 34. 12 ， 由 参考 
文献 [34.1, 5] 所 给 出 。 关 于 光滑 时 变 反 馈 设计 的 
其 他 早期 结果 可 以 在 参考 文献 [34.35, 36] 中 找 
到 。 关 于 连续 (但 不 是 利 普 希 茨 连续 ) 时 变 反 馈 可 
保证 指数 收敛 性 ， 可 见 参 考 文献 【34.37]。 混 杂 离 
散 /连续 固定 点 镇 定 器 的 设计 可 以 在 参考 文献 
[34.38-40] 中 找到 。 命题 34. 14 中 的 控制 律 来 自 参 
考 文献 [34. 6] 。 不 连续 控制 设计 技术 没有 在 本 章 中 
提 及 ,不 过 有 兴趣 的 读者 可 以 在 参考 文献 [34.41, 
42] 中 找到 这 类 反馈 的 例子 。 

据 我 们 所 知 ， 在 第 34.4.6 节 中 给 出 的 基于 横 截 
函数 概念 "1 的 控制 方法 是 首次 尝试 解决 跟踪 任 
意 轨迹 问题 ( 即 对 于 受 控 机 器 人 ， 轨 迹 不 必 是 可 行 
的 ) 。 对 于 此 类 方法 的 实施 问题 和 实验 结果 可 以 在 
参考 文献 [34.10, 11] 中 找到 。 参 考 文 献 
[34.12] 是 关于 轮 式 移动 机 器 人 的 轨迹 跟踪 问题 的 
综述 ， 并 给 出 了 针对 轿车 型 机 器 人 系统 的 一 个 详细 
案例 研究 。 
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本 章 介 绍 了 移动 机 器 人 运动 规划 和 避 障 。 我 们 
将 看 到 这 两 个 领域 如 何不 共享 相同 的 建 模 背景 。 从 
一 开始 的 运动 规划 ， 研 究 一 直 由 计算 机 科学 控制 。 
研究 人 员 的 目的 是 制定 易于 理解 的 完整 性 和 准确 性 
好 的 基础 算法 。 非 完整 约束 的 引入 通过 微分 几何 方 
法 的 引入 迫使 我 们 重视 这 些 算 法 。 这 样 的 组 合 对 某 
些 系 统 已 经 成 为 了 可 能 ， 如 所 谓 的 小 规模 控制 系统 。 
运动 规划 算法 的 基本 假设 仍然 是 一 个 全 球 性 的 准确 
的 地 图 环境 知识 。 更 重要 的 是 ， 所 考虑 的 系统 是 一 
个 具有 方程 组 的 正规 系统 ， 这 些 方 程 组 不 能 描述 整 
个 物理 系统 ， 因 为 没有 考虑 系统 中 的 不 确定 性 建 模 。 
这 些 假设 在 实践 中 过 于 强烈 。 这 就 是 为 什么 其 他 辅 
助 研究 人 员 已 经 采纳 了 一 个 平行 的 ， 更 务实 的 , 但 
现实 的 办 法 处 理 避 障 问题 。 这 里 的 问题 不 是 处 理 复 
杂 的 系统 ， 如 多 拖车 汽车 。 所 考虑 的 系统 非常 简单 ， 
更 重视 它们 的 几何 形状 。 这 个 问题 考虑 了 基于 传 感 
顺 的 运动 ， 现 实 中 的 一 个 真正 的 导航 系统 的 物理 问 
题 要 比 运动 规划 算法 更 好 ， 当 障碍 被 实时 发 现 ， 如 
何在 复杂 环境 下 朝 着 目标 导航 ? 这 是 避 障 的 关键 。 
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趣 的 是 ， 第 一 


个 导航 系统 是 在 第 一 次 国际 联合 人 工 智 
能 (IJCAI 1969 年 ) 会 议 上 提出 的 。 这 些 系统 是 基于 
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一 些 新 生 的 想法 ， 这 些 想法 在 机 器 人 运动 规划 算法 的 
发 展 中 已 卓有成效 。 例 如 ，1969 年 ， 移 动机 器 人 
Shakey 使 用 基于 网 格 的 方法 去 建 模 ， 并 探索 环 
357»; 1979 4E Jason 使 用 了 一 种 由 障碍 边 角 建 立 的 
up LAE). 1979 年 Hilare 把 环境 分 解 成 无 碰撞 凸 
细胞 ”1。 

在 20 世纪 70 年 代 后 期 ， 机 器 人 的 研究 推广 了 机 
械 系 统 构 型 空间 的 概念 ' 沪 和 。 在 构 型 空间 里 ,， “钢琴 
裔 运 工 的 问题 ”( 即 对 于 一 个 刚性 多 面体 如 何 找到 无 
碰撞 路 径 的 问题 ) 成 为 一 个 焦点 。 一 个 机 械 系 统 的 
运动 规划 问题 简化 为 在 构 型 空间 寻找 点 的 路 径 。 这 个 
方法 是 为 了 扩大 开创 性 的 思想 和 开发 新 的 、 有 充分 根 
据 的 算法 。( 见 Latombe WKAR?!) 。 

十 年 后 ， 非 完整 系统 的 概念 (借助 力学 ) 通过 
停车 问题 出 现在 机 器 人 运动 规划 中 号 9 。 移 动机 器 人 
导航 先驱 工作 还 没 解 决 这 个 问题 。 随 后 非 完 整 运动 规 
划 成 为 一 个 引 人 注 目的 研究 领域 号 7 。 

这 项 研究 除了 致力 于 路 径 规划 ， 还 开始 准备 一 些 
工作 为 了 让 机 器 人 走出 最 初 的 人 工 环境 ， 这 些 人 工 环 
境 由 一 些 圆柱 形 木 制 垂 直板 组 成 。 机 器 人 开始 在 人 的 
陪伴 下 走 进 真实 的 实验 大 楼 。 不 准确 的 定位 ， 不 确定 
的 、 不 完整 的 环境 地 图 ， 和 意外 移动 或 静止 障碍 使 机 
器 人 专家 意识 到 路 径 规 划 和 执行 方案 之 间 有 代沟 。 从 
那 以 后 ， 避 障 领域 就 很 活跃 了 。 


35.6 45) GERE (35.7 d$ ~ 35.10 节 ) 的 难题 。 
35. 11 节 回 顾 了 近年 来 成 功 的 方法 ， 它 们 基本 上 包括 
了 运动 规划 和 运动 控制 的 所 有 问题 。 这 些 方法 受益 于 
非 完整 运动 规划 和 避 障 方法 。 


35.1 非 完整 移动 机 器 人 : 运动 规划 
满足 控制 理论 


非 完整 约束 在 速度 空间 系统 下 是 不 可 积 线性 约束 
的 。 例 如 ,无 滑动 约束 的 滚动 差 速 驱动 移动 机 器 人 
(图 35.1) 是 差 速 驱动 机 器 人 线性 速度 矢量 (线性 向 
和 角速度 ) ， 并 且 是 不 可 积 的 〈 它 不 能 整合 成 为 一 
个 配置 变量 约束 )。 因 此 ， 一 个 差 速 驱动 移动 机 器 人 
可 以 去 任何 地 方 ， 但 不 遵守 任何 轨迹 。 当 考虑 了 二 阶 
微分 方程 ， 如 惯性 动量 守恒 ， 其 他 类 型 的 非 完 整 约束 
就 被 提出 来 了 。 大 量 论 文 调查 了 著名 的 下 落 猫 问 题 和 
在 空间 自由 漂浮 的 机 器 人 问题 ( 见 参 考 文献 [35.7] 
概述 ) 。 本 章 专门 讨论 轮 式 移动 机 器 人 的 非 完 整 约束 
问题 。 
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图 35.1 由 于 没有 车 轮轴 滑动 约束 的 滚动 ， 
差 速 驱动 移动 机 器 人 受 线性 动力 学 约束 支配 


如 果 由 于 障碍 在 构 型 空间 上 的 直接 约束 ， 而 且 这 种 约 
束 是 多 样 化 的 ， 那 么 非 完 整 约束 就 可 以 表达 在 正切 空 
间 。 对 一 个 线性 动力 学 约束 的 表示 ， 自 然 就 产生 了 一 
个 首要 问题 : 这 种 约束 可 以 减少 系统 空间 的 可 达 性 
吗 ? 这 个 问题 的 答案 可 以 通过 学 习 被 控 系 统 的 李 氏 代 
数 分 布 结构 来 获得 。 

即使 在 没有 障碍 物 的 前 提 下 ， 对 一 个 非 完整 系统 
的 两 个 构 型 之 间 规 划 可 行 性 运动 (如 ， 满 足 运 动 学 
约束 ) 也 不 是 一 件 容 易 的 事 。 准 确 的 解决 方案 已 经 
被 提出 来 了 ， 不 过 只 适合 某 些 系统 ， 还 有 很 多 系统 没 
有 很 好 的 解决 方法 。 在 一 般 情况 下 ， 一 个 近似 方法 是 
可 以 使 用 的 。 

对 于 一 个 非 完 整 系统 的 运动 规划 问题 可 以 表述 如 
下 : 在 工作 空间 内 给 定 一 个 有 障碍 的 情景 地 图 ， 一 个 
机 器 人 受到 非 完整 约 束 ， 初 始 构 型 ， 目 标 构 型 ， 找 到 
一 个 初始 和 目标 构 型 之 间 的 无 碰撞 路 径 。 解 决 这 个 问 
题 需要 考虑 到 由 于 障碍 带 来 的 双方 构 型 空间 的 限制 ， 
和 非 完 整 约 束 。 解 决 这 个 问题 需要 开发 的 工具 要 有 运 
动 规划 与 控制 理论 技术 。 由 于 拓扑 参数 的 出 现 使 得 这 
样 的 组 合 对 所 谓 的 小 时 间 控 制 系统 成 为 了 可 能 
(35.3 节 定 理 35. 2)。 


运动 学 约束 与 可 控 性 


在 本 节 中 ， 我 们 提供 有 关 可 控 的 主要 定义 ， 使 用 


Sussman 的 术语 5531 。 


pi 


35.2 


35.2.1 定义 


我 们 用 CS 表示 维 数 是 n 构 型 是 g 的 给 定 移动 机 
器 人 的 构 型 空间 。 如 果 机 器 人 被 装 在 轮子 上 ， 它 是 受 
运动 约束 的 ， 线 性 速度 向 量 
w,(q)q=0,ie 11, ,k] 
我 们 假设 ， 这 些 限制 对 每 4 是 线性 无 关 的 、 等 价 
的 ， 对 每 个 g， 这 里 存在 m = -hk， 线 性 无 关 向 量 
Ala), css f,(9)， 上 述 限制 可 以 等 价 为 ; 
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d(u,,,u,)e R",q- fia) (35. 1) 

我 们 注意 到 ， 向量 fA MEA, Ie, 
无 论 我 们 选择 什么 ， 以 下 所 有 的 事态 发 展 是 有 效 
的 。 此 外 ， 如 果 线 性 约束 是 平稳 的 ， 对 于 4 向 量 
afi, oy 访 也 是 平稳 的 。 从 现在 开始 我 们 假定 这 
种 条 件 。 

让 我 们 定义 VU， 一 系列 子 集 R”。 我 们 用 定义 
控制 系统 式 (35.1), 其 中 (uy, 0, un) EUo 

定义 35.1 

局 部 和 小 规模 可 控 性 

1) 王 是 关于 构 型 g 局 部 可 控 的 ， 当 且 仪 当 构 
ANAFI q 且 轨 迹 包 含 它 邻近 的 qo 

2) 三 是 关于 构 型 gq 小 规模 可 控 的 ， 当 且 仅 当 
构 型 达到 q 且 轨 迹 小 于 7 了 并 包含 任何 7 邻近 的 qo 

万 ，…， 矿 被 称 为 二 的 控制 向 量 场 。 一 个 系统 
在 每 个 构 型 小 规模 可 控 时 被 认为 是 小 规模 可 控 的 。 


35. 2.2 可 控 性 


检查 一 个 系统 的 可 控 性 要 求 分 析 与 系统 相关 的 控 
制 李 氏 代数 。 让 我 们 以 非 正式 方式 说 明 什 么 是 李 氏 同 
类 项 。 考 虑 两 个 基本 运动 : 沿 着 一 条 直线 和 定点 旋 
转 ， 分 别 记 为 /和 &， 现 在 考虑 下 面 的 组 合 ; 在 时 间 ， 
内 前 进 ， 在 相同 的 时 间 内 顺 时 针 转 动 ， 在 同一 时 间 
内 倒退 ， 然 后 在 时 间 4 内 逆 时 针 转动 。 该 系统 到 达 一 
个 非 初始 构 型 。 当 然 ， 当 1 趋 于 0 时， 目标 构 型 非常 
接近 初始 构 型 。 当 ! 趋 于 0 时， 方向 所 示 的 目标 构 型 
就 对 应 到 一 个 新 的 向 量 空间 ， 即 /和 g 的 李 氏 同类 
项 。 在 数学 公式 中 ， 两 个 向 量 场 /和 的 李 氏 同类 项 
[f, g] 被 定义 为 向 量 场 9fg -3gf。[f, g] 的 第 个 
坐标 即 为 
Lele] = X (elil gs LA) -S Lil 5 

TERRE ORR ( 当 U 
关于 原点 对 称 时 ， 系 统 被 认为 是 对 称 的 ) 

定理 35. 1 

当 且 仅 当 向 量 空间 跨越 所 有 向 量 场 / 和 g 的 所 
有 同类 项 时， 一 个 对 称 系统 是 关于 构 型 g 小 规模 
可 控 的 。 

检查 控制 系统 上 的 李 氏 代数 秩 条 件 (LARC) 包 
括 试图 由 一 个 跨越 控制 向 量 场 的 自由 李 氏 代数 的 基础 


35.2.3 示例 : 差 速 驱动 移动 机 器 人 


为 了 说 明 这 一 节 新 概念 ， 我们 用 图 35. 1 来 考虑 
差 速 驱 动 移动 机 器 人 。 这 种 机 器 人 的 构 型 空间 是 
R ”xS ， 一 个 构 型 可 以 由 g = (x, y, 0) 表示 ， 这 里 
(x, y) 是 机 器 人 中 心 轴 水 平 位置 ，9 表示 x 轴 方 向 。 
Aci RW a AZAR 

— XsinÜ + ycos0 =0 

其 相对 于 速度 向 量 (x, y, 0) 是 线性 的 。 

此 ， 容 许 速度 的 子 空 间 跨 越 了 两 个 向 量 场 ， 例 如 : 


cosO 0 
/1(g) iz] 和 sofi (35.2) 
0 1 


这 两 个 向 量 场 的 李 氏 同类 项 是 


sin0 
A(@) = | “ma 
0 


这 意味 着 ,对 任何 构 型 g， 跨 越 /(q)、f(g)、 
f) 的 向 量 空间 的 秩 是 3， 因 此 差 速 驱 动 移动 机 带 
人 是 小 规模 控制 。 


35.3 ”运动 规划 和 小 规模 控制 
运动 规划 提出 了 两 个 问题 : 一 是 无 碰撞 容许 路 径 
(决策 问题 ) 的 存在 ， 二 是 这 样 的 路 径 的 计算 (完成 


问题 ) o 


35.3.1 决策 问题 


从 现在 开始 ， 我 们 假定 无 碰撞 构 型 集合 是 开 子 
集 。 这 意味 着 ， 接 触 构 型 是 在 碰撞 里 假定 的 。 

EH 35. 2 

两 个 构 型 间 的 对 称 小 规模 控制 移动 机 器 人 无 碰 
撞 容 许 路 径 的 存在 相当 于 存在 着 这 些 构 型 间 的 无 碰 
撞 路 径 (不 一 定 是 容许 的 ) 。 


WEB]. 让 我 们 看 一 下 构 型 qg 和 g, 之 间 的 非 必须 
容许 的 无 碰撞 路 径 作 为 一 个 连续 映射 夏 ， 从 区 间 [0， 
1] 到 构 型 空间 CS, Rare: 

1) 7 0) =q, TO) = 和 。 

2) 对 任意 xse[0,， 1], TG) 是 无 碰撞 的 。 

第 2 点 意味 着 ， 对 任意 的 1， 存 在 一 个 (5) 的 
邻 域 U0(1) 包括 构 型 空间 的 无 碰撞 子 集 。 
我 们 记 e(t) AMI) 开始 的 碰撞 轨迹 的 较 大 时 间 


cL 


(例如 ， 一 个 P. Hall 家 族 ) 来 建立 的 正切 空间 。 人 参考 
文献 [35.10, 11] 提出 了 一 个 算法 。 


下 限 。 控 制 向 量 (uy, c, un) DREZE U, elt) >0。 
因为 该 系统 是 关于 厂 (1) 的 小 规模 控制 ， 从 
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(7) 开始 ， 在 时 间 上 小 于 e(1) 的 (1) 相 邻 的 集合 
我 们 记 为 V(t) 。 

合集 IV), te [10, 1]] BAR |T(1), te 
[0, 1]! WAM, Ale, 我们 可 以 提取 一 个 有 限 
履 盖 范围 : | Vt)，…,V(4)| ,其 中 w=0<w <… 
<t <t=1, 像 这 样 对 于 任意 一 个 1 4811-1 之 间 的 
i, Vti) AV, ) 壮 4。 对 于 1 和 1-1 之 间 的 每 一 
个 i， 我 们 选择 一 个 在 V(t,) V(t,,) 的 构 型 r,。 由 
于 该 系统 是 对 称 的 ， 存 在 一 个 g(t,) Flr, Za), rU 
q(,,,) 之 间 的 无 磁 撞 路 径 。 这 些 路 径 的 串联 是 一 个 
gi 和 g, 之 间 的 无 磁 撞 容许 路 径 。 


35. 3.2 ”完整 问题 


在 前 节 中 ， 我们 建立 了 决策 问题 ， 即 确定 在 两 种 
构 型 之 间 是 否 存在 一 个 无 碰撞 容许 路 径 ， 相 当 于 确定 
该 构 型 是 否 在 同一 连通 的 无 碰撞 构 型 空间 。 在 这 一 
节 ， 我 们 现在 用 所 需要 的 工具 来 解决 完整 问题 。 这 些 


算法 35. 1 

近似 函数 : 输入 一 个 路 径 工 和 沿 着 这 个 路 径 
的 两 个 横 坐 标 t P to 

如 果 SeT), (ts)) 无 碰撞 ， 那 么 

RE Suel TC), DP(5)) 

否则 

返回 〈 近 似 值 (D, t, 
(ài CP, (i 4%) Z2, m) 

结束 

2. 基于 采样 的 路 线 图 方法 

(E58 5 章 所 描述 的 大 多 数 基于 采样 的 路 线 图 方法 
可 以 适应 非 完整 系统 ， 取 代 基 于 局 部 转向 方法 的 构 型 
对 间 的 连接 方法 。 这 种 方案 对 于 PRM 算法 是 相当 有 
效 的 。 对 于 快速 随机 树 (RRT) 方法 ， 其 效率 在 很 大 
程度 上 依赖 于 用 来 就 近 选 择 的 尺度 。 两 种 构 型 之 间 的 
距离 函数 需要 描述 通过 局 部 转向 函数 返回 连接 这 些 构 
型 路 径 的 长 度 '* 1。 


(t +#,) 72), 3 


- 具 虽 然 融 合 了 第 5 章 讲 到 的 经 典 运动 规划 问题 和 
环 控 制 理 论 ， 但 是 需要 进一步 改进 ， 这 部 分 我 们 将 在 
下 一 节 中 讲 到 。 对 于 非 完 整 系统 ， 为 了 规划 容许 无 碰 
撞 运 动 而 设计 了 两 种 主要 方法 。 首 先 ， 参 考 文献 
[35.12] 提出 了 建议 ， 利 用 定理 35.2. 的 证 明 思 维 ， 
即 递 归 带 近 一 个 非 必须 容许 的 ， 通 过 一 系列 可 行路 径 
的 无 磁 撞 路 径 。 第 二 种 方法 取代 了 概率 网 法 (PRM) 
算法 (第 5 章 ) 这 种 局 部 方法 ， 这 种 方法 通过 局 部 
转向 函数 由 容许 路 径 与 构 型 对 联系 。 

这 两 种 方法 都 使 用 了 一 种 转向 函数 。 简 要 介绍 它 
们 之 前 ,我 们 给 出 了 一 个 局 部 转向 函数 的 定义 。 

定义 35.2 

系统 二 的 一 个 局 部 转向 函数 是 一 个 映射 的 
THR. 


N 


Sie :CS x CSC}, ([0,1], CS) 
(4,43) Œ S. (41,42) 
XP, Sq, h) 是 分 段 连 续 可 微 曲 线 ，CS 满 
足以 下 性 质 . 
1) Selli q,) 满足 与 了 相关 的 运动 学 限制 。 
2) Sellis 0) ays DRZ: SLC a. 
q) 0) =q, Selli; %) (1) 245. 
1. 一 条 不 一 定 容许 路 径 的 近似 
一 条 不 一 定 容许 无 碰撞 路 径 (1), te [0，1] 


连接 两 个 构 型 和 给 定 的 局 部 转向 


函数 Su， 近 似 算 法 


用 算法 35.1 中 定义 的 近似 函数 进行 递归 ， 该 近似 算 


EAD, 0 和 1。 


35.4 局 部 转向 函数 与 小 规模 的 控 


制 性 


节 提 到 的 近似 算法 引出 了 更 具体 的 问题 ， 这 
和 否 能 在 有 限 的 时 间 内 完成 ， 是 否 无 法 得 到 一 


E 


在 前 面 章 
个 算法 是 
个 解 。 

在 有 限 的 迭代 次 数 里 找到 一 个 解决 办 法 的 近似 算 
法 的 一 个 充分 条 件 是 用 局 部 转向 函数 说 明 小 规模 系统 
的 可 控 性 。 

定义 35.3 

一 个 局 部 转向 函数 .用 来 解释 系统 二 小 规模 
的 可 控 性 当 且 仅 当 对 任意 ge CS MEERE U, 存 
在 一 个 g 的 任意 邻 域 V 使 得 对 任意 r eV, Salg, r) 
( [0, 1]) CU, 


换 名 话说， 如果 局 部 转向 函数 与 它 相 关联 的 参数 
相互 接近 的 同时 使 路 径 变 得 更 为 接近 设 定 ， 则 它 表 明 
了 小 规模 系统 的 可 控 性 。 

这 个 特性 也 充分 说 明了 抽样 方法 的 路 线 图 的 概率 
完整 性 。 
35.4.1 局 部 转向 函数 用 来 说 明 小 规模 系统 

的 可 控 性 

构建 一 个 局 部 函数 说 明 小 规模 系统 的 可 控 性 是 一 
项 艰巨 的 任务 ， 目 前 只 为 几 类 系统 构建 出 了 该 函数 。 
大 多 数 在 运动 规划 领域 中 研究 的 移动 机 器 人 都 是 轮 式 


mb 
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移动 机 器 人 有 牵引 的 拖车 或 没有 。 

1. 使 用 最 优 控制 进行 控制 

最 简单 的 系统 即 在 35. 2. 3 节 中 提 到 的 用 有 限 的 
速度 或 所 谓 的 有 限 曲 率 的 RS 4E 05 分 别 驱动 机 器 人 
时 有 相同 的 控制 矢量 领域 式 (35.2)。 他 们 之 间 的 区 
别 在 于 不 同 的 控制 变量 领域 ， 

对 于 RS 车 ; -1<u,<1, |u,|<|u, | 

对 于 差 速 驱动 机 器 人 : |u |+blu,|<1 
APF, b 是 左右 轮 之 间距 离 的 一 半 。 对 于 这 些 系统 ， 
可 以 使 用 最 优 控制 理论 来 构造 出 局 部 转向 函数 来 说 
明 小 规模 系统 的 可 控 性 。 我 们 把 其 中 一 个 系统 的 间 
隔 T 定 义 成 任意 的 容许 路 径 ， 以 下 是 我 们 定义 的 
长 度 : 

XT RS £s | lu, | 


对 于 差 速 驱动 机 器 人 : | lu, 1+ b [us | 
两 个 构 型 之 间 的 最 短路 径 长 度 定义 了 两 种 情况 下 
构 型 空间 的 一 种 度量 。 最 短路 径 的 综合 ， 比 如 任何 一 
对 构 型 之 间 的 最 短路 径 都 可 以 被 测定 ， 特 别 像 参考 文 
献 [35.15] 的 RS 汽车 ， 及 后 来 参考 文献 【35. 16 ] 
提 及 的 差 速 驱动 (DD) 机 器 人 。 图 35.2 给 出 了 基于 


这 种 度量 的 球状 模型 。 


2 
0 
-2 Ge 
0 


a) 


图 35.2 a) RS 球 的 两 个 透视 图 : 路 径 长 度 小 于 给 定 距 

BH) Reeds&Shepp 车 的 可 用 构 型 集 b) 两 个 DD 球 的 

透视 图 : 路 径 长 度 小 于 给 定 距 离 的 差 速 驱动 机 器 人 的 可 
用 构 型 集 。 方向 9 SZ 轴 重 和 。 


b) 


最 优 控制 自然 定义 了 一 种 与 任何 一 对 构 型 相关 的 
局 部 转向 函数 ， 即 构 型 之 间 的 最 短路 径 。 我 们 应 该 注 
意 到 最 短路 径 在 大 多 数 成 对 的 构 型 中 是 独一无二 的 。 
一 般 的 结果 表明 以 q 为 中 心 、 半 径 x > 0 的 圆 组 成 了 
一 个 集合 ， 这 个 集合 是 由 非 完 整 度量 组 成 一 个 增长 的 
q 的 相 邻 集合 和 1g) 的 交集 所 构成 的 。 这 种 性 能 
接地 表明 了 基于 最 短路 径 的 局 部 转向 函数 能 解释 小 规 
模 的 可 控 性 。 

最 优 控制 主要 的 优点 是 提供 了 两 种 方法 ， 即 局 部 
控制 方法 和 与 其 一 致 的 距离 度量 。 这 使 控制 方法 很 好 
地 适合 了 专 为 完整 系统 和 使 用 距离 函数 设计 的 路 径 规 
划算 法 ， 例 如 RRT (第 5 章 )。 

遗憾 的 是 ， 在 这 一 节 中 最 短路 径 的 综合 仅仅 在 两 
种 简单 的 系统 中 被 实现 。 对 于 复杂 的 系统 ， 问 题 依然 
存在 。 

在 这 一 节 中 描述 了 基于 控制 方法 的 最 短路 径 的 主 
要 缺点 ， 即 输入 函数 的 不 连续 性 。 在 动作 执行 前 ， 这 
就 需要 一 个 额外 的 步骤 去 计算 路 径 的 时 间 参 数 。 在 时 
间 参 数 下 ， 输 入 的 不 连续 性 迫使 机 器 人 停 下 来 。 比 如 
有 两 段 连续 的 、 曲 率 相反 的 圆 弧 ， 机 器 人 需要 在 他 们 
中 间 停 下 来 ， 目 的 是 确保 线 型 的 连续 性 和 角速度 u 
和 o 

2. 转向 链接 结构 系统 

通过 参数 变换 ， 一 些 级 别 的 系统 可 以 被 输入 到 一 
种 称 作 链 接 结 构 系 统 中 。 


x, =u (35.3) 
z, =u (35.4) 
22u (35.5) 
E: (35.6) 
i. x4 1 (35.7) 


URNE FE d ACT. 
f (t) =a * a,sinot 


u, (t) =b) +b, coswt ++- * b, ,cos(n —2) wt 


(35.8) 

iEZ™ e 民 "作为 开始 构 型 。 每 一 个 za:(1) 可 以 
通过 2" 的 坐标 与 参数 (ay, a, by, bite, bna) 
被 计算 出 来 。 对 于 给 定 的 a, #0 和 给 定 的 构 型 zr. 
从 (ay, bo, bi, ba, b) 到 Z (1) 的 映射 是 一 个 在 
原点 的 C!' 一 微分 同 胚 映射 ,然后 系统 是 可 逆 的 。 对 
于 小 于 或 等 于 5 的 数 n， 参数 (ay, bo, bon, 
ba) 可 以 通过 两 种 构 型 ZW 和 Ze W^ e. 4H 
应 的 正弦 输入 将 系统 从 Z™ 到 Zs" 进行 了 转向 。 路 径 
的 形状 唯一 取决 于 参数 mw ， 每 一 个 w 的 值 定义 了 一 
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种 局 部 转向 函数 ， 表 示 为 5 。 对 于 任何 的 Ze R"， 
这 些 转向 函数 不 能 解释 小 规模 的 可 控 性 ，SA% (Z，2) 
( [0, 11) 不 能 简化 为 1Z| 。 通 过 采集 5% 去 建立 一 
种 局 部 转向 函数 ， 去 解释 小 规模 的 可 控 性 ， 我 们 需要 
使 a 依赖 于 构 型 7 和 2 。 

lm a (Z',Z)z0 


Jim, a (CZ ,Z a (Z ,2)) =0 
Him, (2 2 ,a,(Z',Z°)) =0 

这 种 结构 可 以 在 参考 文献 [35.18] 中 获得 。 

3. 转向 反馈 可 线性 化 系统 

反馈 可 线性 化 性 (或 微分 平滑 ) 的 概念 是 由 
Fliess 等 人 中 介绍 的 。 一 个 系统 如 果 存 在 一 个 输 
出 (如 ,一 个 状态 函数 ,输入 和 输入 导数 ) 被 称 为 
线性 输出 ， 则 这 个 系统 被 认为 是 反馈 线性 化 系统 ， 这 
种 状态 和 系统 的 输入 都 是 线性 输出 的 函数 和 相应 的 导 
数 。 而 该 线性 化 的 输出 和 输入 维度 相同 。 

让 我 们 用 一 个 简单 的 例子 说 明 这 一 观点 。 我 们 认 
为 ,一 个 差 速 驱动 的 移动 机 器 人 拖车 ， 如 图 35.3 所 
示 ， 拖 车 挫 在 机 器 人 的 轮子 轴 上 。 由 该 拖车 的 车 轮轴 
心 的 曲线 切线 给 出 了 拖车 的 方向 。 从 拖车 沿 曲线 的 行 
进 方向 ， 我 们 可 以 推断 出 曲线 跟随 机 器 人 的 中 心 。 跟 
随机 器 人 的 中 心 的 曲线 切线 给 出 了 机 器 人 的 行进 方 
向 。 因 此 ， 本 系统 的 线性 化 输出 为 该 拖车 的 车 轮轴 
心 。 通 过 两 次 差分 线性 输出 ， 我 们 可 以 重 构 该 系统 的 
构 型 。 

反馈 线性 化 对 于 转向 的 目的 是 很 有 意义 的 。 事 实 
上 ， 线 性 化 输出 不 受 任何 运动 的 限制 。 因 此 ， 如 果 我 
们 知道 状态 和 线性 输出 的 关系 ， 在 两 个 构 型 之 间 规 划 
一 条 人 允许 路 径 需要 简单 地 建立 一 个 民 "空间 内 曲线 ， 
其 中 m 是 两 端 差异 约束 的 输入 维 数 。 而 这 个 问题 可 
以 迎刃而解 ， 比 如 ， 利 用 多 项 式 。 

对 于 两 个 输入 无 漂移 系统 ， 如 求 和 ， 线 性 输出 仅 
仅 取 决 于 状态 gqg， 同 时 状态 q 取决 于 线性 输出 ， 这 些 
输出 通过 固定 值 参数 化 获得 ， 即 线性 输出 y, UKS 
y 曲线 相 切 的 向 量 的 方向 r， 且 7 的 连续 导数 与 曲线 的 
横 坐 标 s AŽ, 
因此 ,一 个 n 维 、 双 输入 线性 反馈 无 漂移 系统 的 
构 型 可 以 由 一 个 向 量 (y, T, €, ee, UO) 来 表示 ， 
该 向 量 表示 穿 过 构 型 的 可 容许 路 径 的 线性 输出 曲线 的 
几何 特性 。 

因此 ,设计 一 个 系统 的 局 部 转向 函数 等 效 于 关联 
任何 向 量 对 (y,, 0. To wo TS), On 5. 
T, e, 07) 平面 内 一 条 曲线 从 y, FRE y, 结束， 


(xi, x2) 


图 35. 3 ”一 个 挂 着 拖车 的 差 速 驱动 机 器 人 的 车 轮 的 轴 

线 前 端 是 一 个 线性 反馈 系统 。 它 的 线性 输出 是 拖车 车 

轮 的 轴线 中 心 。 系统 的 构 型 可 以 通过 曲线 y(s) 的 微分 

来 重 构 ， 这 里 的 ; 是 一 个 跟随 线性 输出 的 参数 化 弧 长 。 

拖车 的 方向 由 7 = arctan( y /7 ,) 给 定 。 机 器 人 与 拖 

车 之 间 的 角度 由 p = -1arctan(dzds) 给 定 ， 其 中 ! 是 拖 
车 连接 的 长 度 


沿 向 量 切线 方向 对 s RE BEB, ah TE Mt, 
Too, TOP, AT, T, e, TORR, RT 
作 在 使 用 了 多 项 式 和 改造 了 多 项 式 的 系数 使 其 成 为 线 
性 方程 组 的 边界 条 件 后 ， 变 得 相对 容易 了 。 不 过 ， 考 
虑 了 小 规模 可 控 性 以 后 有 些小 小 的 难度 。 

参考 文献 [35.21] 提出 了 一 种 建立 在 标准 曲线 
的 凸 组合 的 平滑 转向 函数 。 


链 式 系统 与 反馈 可 线性 化 系统 的 
等 价 


在 上 一 节 中 ,我 们 分 析 了 反馈 可 线性 化 控制 
系统 和 可 转换 为 链 式 结构 的 系统 的 转向 函数 ， 现 
在 来 给 出 一 个 系统 为 反馈 可 线性 化 的 充分 必要 
条 件 。 

系统 为 反馈 可 线性 化 系统 的 充分 必要 条 件 : 

在 参考 文献 [35.22] P, Rouchon 给 出 了 判断 
一 个 两 输入 无 漂 系 统 是 否 为 反馈 可 线性 化 系统 的 条 
件 。 对 于 一 个 两 输入 无 漂移 系统 的 充分 必要 条 件 如 
下 : 定义 分 布 集合 (如 向 量 场 的 集合 ) HA, K>0, 
TCE MW 等 于 0f, Al 之 间 的 跨度 ，A, 等 于 
th, A. DA. Al} 之 间 的 跨度 , A, AS + [A 
A], HP [A, Aj] 等 于 LA g], fed, geA,| 
之 间 的 跨度 。 当 且 仅 当 rank(A;) 22 +i 时 , 一 个 二 
维 输入 系统 为 反馈 可 线性 化 系统 。 


35.4.2 
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135.1: 链 式 系 统 。 链 式 系统 的 定义 参照 式 

(35.3) ~ 式 (35.7) 。 这 个 系统 控制 矢量 场 为 : f= 
(1, 0, 4, a z 1), 4 = (0, 1, +, 0), 
rnkA, 22, ^ f, =[f,, f] = (0,0, 1, 0, 7, 
0) ， 则 可 得 到 rankA, 23, 
由 于 f=[f, fil (i=1, 2, =, n), 代入 计 
7113 f, 2(0, =, 0, 1,0,…, 0), 其 中 1 正好 位 
Tm SE RUTAS iu; 因此 rank (A,) =2 +i(i =1, 
2，… 妈 -2) ， 这 个 链 式 系统 是 反馈 可 线性 化 的 。 我 
们 还 可 以 通过 分 析 (z,, z) 和 其 导数 重 构 出 的 状态 
这 种 直接 的 方法 得 出 上 述 结论 。 因 此 (z,, zm) 可 认 
为 是 链 式 结构 系统 的 线性 化 输出 。 


35.5 机 器 人 和 拖车 


本 章 主 要 研究 移动 机 器 人 和 牵引 一 个 或 多 个 拖车 
组 成 的 机 器 人 系统 的 路 径 规 划 问题 。 这 些 系统 的 输入 
都 是 二 维 的 。 


35.5.1 差 速 驱动 移动 机 器 人 


最 简单 的 移动 机 器 人 ， 即 差 速 驱动 移动 机 器 人 。 
由 图 35.1 可 以 看 出 ， 该 机 器 人 的 轮轴 中 心 的 轨迹 
(线性 化 输出 ) 就 是 机 器 人 的 运动 方向 ， 显 然 该 系统 
是 反馈 可 线性 化 的 。 因 此 可 以 用 基于 平滑 的 局 部 转向 
函数 来 引导 移动 机 器 人 。 


35.5.2. ” 率 引 一 辆 拖车 的 差 速 驱动 移动 机 器 人 


图 35. 3 中 的 通过 机 器 人 的 车 轮轴 心 牵引 一 辆 拖 

车 的 差 速 驱动 移动 机 如 人 是 反馈 可 线性 化 的 ， 拖 车 的 
轮轴 中 心 轨迹 是 一 个 线性 输出 。 图 35. 4 中 通过 一 个 
主 销 牵引 一 辆 拖车 的 差 速 驱动 移动 机 器 人 也 是 反馈 可 
线性 化 的 ， 具 体 见 参考 文献 【35.23] ， 但 是 该 系统 
的 线性 输出 和 结构 变量 之 间 的 关系 更 加 复杂 。 
bsin0 + asin(0 4 ) 

a +b? +2abcosh 
acos( 0 +p) + bcos0 

a +b +2abcosg 
IUP, 也 由 下 列 椭圆 积分 得 到 : 
由 


L() = ab 


bcos0 + L() 


Ji =% 


bsinü - L() 


J=% 


coso 
do 


Va + b + 2abcosa 
这 是 一 个 线性 输出 系统 ， 他 们 之 间 的 关系 可 用 下 


asin(0 +h) + bsin@ 
bcos0 + acos( 0 +Q) 


tan T= 


图 35.4 通过 主 销 牵 引 一 个 拖车 的 差 速 驱动 
移动 机 器 人 是 反馈 可 线性 化 的 


iz sind 
cosh Va +b +2abcosh + L( ) sind 
我 们 可 以 由 线性 化 输出 和 它 的 两 个 一 阶 导 数 来 重 
构 系 统 的 结构 变量 。 


35.5.3 轿车 型 移动 机 器 人 


轿车 型 移动 机 器 人 (ILAI 35.5) 由 一 个 固定 
和 两 个 可 转向 的 前 轮 组 成 ， 其 中 前 轮 的 轴线 相交 于 曲 
率 中 心 。 该 机 器 人 运动 学 模型 等 效 于 通过 机 器 人 的 车 
轮轴 心 牵引 一 辆 拖车 的 差 速 驱动 移动 机 器 人 ( 见 
图 35.3) : 虚拟 前 轮 相 对 应 于 差 速 机 器 人 ， 而 车 身 对 
应 拖车 。 


9 
0 
图 35.5 四 轮 轿车 型 移动 机 器 人 。 前 轮 的 轴线 相交 


于 曲率 中 心 ， 转 向 角 9 是 汽车 纵 轴 和 两 个 前 轮 中 间 
的 虚拟 前 轮 之 间 的 夹 角 


35.5.4 前 后 车 轮 均 可 转向 的 机 器 人 


前 后 车 轮 均 可 转向 机 器 人 〈 见 图 35.6) 相当 于 
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一 种 可 控制 前 后 车 轮转 向 和 前 后 轮 之 间 角 度 的 汽车 。 ”真正 看 到 链 式 系统 也 是 这 类 的 一 部 分 。 对 于 其 他 系 
该 系统 在 参考 文献 [35.24] 中 已 被 证 明 是 反馈 可 线 。 统 ， 至 今 还 没有 一 个 准确 的 方法 来 判断 ， 例 如 ， 图 
性 化 的 。 该 机 器 人 通过 主 销 拖 动 拖车 的 组 成 的 机 器 人 ”35.7 显示 的 两 个 系统 都 不 是 反馈 可 线性 化 的 ， 他 们 
系统 ， 线 性 化 输出 是 在 机 器 人 参照 系 中 一 个 移动 并 不 满足 35.4.2 节 的 必要 条 件 。 

的 点 。 


of? m : 
| TNT 
BL £5 


图 35.7 轿车 型 移动 机 器 人 通过 主 销 拖 着 一 个 拖 杆 拖 
车 系统 和 差 速 驱动 移动 机 器 人 通过 主 销 拖 着 两 个 拖车 ， 
都 为 非 完 整 系统 的 精确 路 径 


图 35.6 前 后 车 轮 均 可 转向 的 机 器 人 。 HAM 
后 方 车 轮 均 可 转向 ， 前 、 后 轮转 向 角 之 间 的 关系 
为 : a-2f(o) 


35.5.5 率 引 多 辆 拖车 的 差 速 驱动 移动 机 器 人 
35.6 


我 们 已 经 分 析 了 通过 机 器 人 的 车 轮轴 心率 引 - 辆 ”35"6 近似 方法 
拖车 的 差 速 驱动 移动 机 器 人 ， 现 在 添加 任意 数量 的 拖 
车 ， 每 一 个 拖车 都 连接 在 前 一 个 拖车 轮轴 的 中 心 。 通 
过 对 最 后 拖车 中 心 的 曲线 微分 后 ， 我 们 得 到 最 后 一 个 
拖车 的 运动 方向 (这 个 方向 同 曲线 切线 方向 一 致 )。 
如 果 知 道 沿路 径 的 最 后 一 个 拖车 的 运动 方向 和 中 心 位 35.6.1 正 向 动态 规划 
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为 了 求 出 不 属于 任何 一 类 非 完整 系统 的 精确 解 ， 
近似 数值 解法 得 到 发 展 。 我 们 在 本 节 中 回顾 一 下 这 些 


置 ， 就 可 以 重 构 他 前 面 的 拖车 中 心 的 运动 轨迹 ， 重 复 

这 一 过 程 ， 我 们 可 以 多 次 微分 ， 来 重 构 整 个 系统 的 轨 Barraquand 和 Latombe 在 参考 文献 [35.25] 中 
迹 。 因 此 ， 该 系统 是 反馈 可 线性 化 的 ， 线 性 化 输出 是 “提出 了 一 个 非 完 整 路 径 规划 的 动态 编程 方法 。 在 固定 
最 后 拖车 的 中 心 。 的 时 间 间 隔 %， 由 一 个 连续 的 输入 序列 产生 可 容许 的 


综合 本 节 推导 过 程 ， 我 们 可 以 建立 一 个 混合 的 反 ”路径 ， 从 最 初 的 构 型 中 搜索 生成 一 个 树 : 通过 设置 笨 
馈 可 线性 化 的 拖车 系统 。 例 如 ， 一 个 差 速 驱动 移动 机 ”入 为 一 个 固定 值 ， me ce Mine d 
PAMALE n 量 拖 车 ， 除 了 最 后 一 辆 拖车 勾 住 主 销 。 ”积分 获得 一 个 给 定 的 构 型 g 的 子 代 9” 。 构 型 空间 被 
外 ， 其 他 前 面 的 每 一 个 拖车 都 连接 在 车 轮 连接 轴 中 离散 化 为 一 个 同样 大 小 细胞 数组 (如 ， E 
心 ， 这 样 的 一 个 系统 也 是 反馈 可 线性 化 的 。 可 以 把 最 ” 体 ) 。 当 且 仅 当 从 4 到 4” 是 无 碰撞 的 ，g” 不 属于 已 
后 两 辆 拖车 组 成 的 系统 简单 看 做 图 35.4 中 的 系统 ， 经 生成 的 构 型 中 的 一 个 单元 时 , 将 gq 的 子 代 q” 插 入 
也 是 反馈 可 线性 化 系统 ， 由 该 系统 的 线性 化 输出 使 我 。 到 搜索 树 。 当 生成 目标 构 型 时 ( 即 同一 个 细胞 ， 并 
们 能 够 重 构 最 后 两 辆 拖车 的 轨迹 。 第 n -1 辆 拖车 的 不 需要 准确 地 达到 目标 ) ， 该 算法 停止 。 


中 心 是 移动 机 器 人 拖 最 后 n -1 辆 拖车 时 的 线性 化 不 管 是 对 5t 还 是 对 细胞 的 数量 来 说 ， 该 算法 已 
输出 。 被 证 明 是 渐 近 完成 的 。 由 于 该 算法 比较 粗糙 ， 离 实用 


还 有 很 长 的 路 要 走 。 值 得 关注 的 是 ， 该 搜索 是 基于 

需要 

35.5.6 需要 说 明 的 问题 Dijkstra 的 算法 ， 允 许 考虑 采取 最 优 标准 ， 如 路 径 长 
最 后 对 于 我 们 能 够 在 任意 对 构 型 之 间 规划 准确 运 。” 度 或 反 转 的 次 数 。 产 生 最 小 反 转 的 浙 近 最 优化 仅 被 证 

动 的 所 有 系统 都 被 归 为 线性 反馈 的 大 种 类 。 我 们 已 经 。 明 在 轿车 型 机 器 人 中 应 用 。 
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35.6.2 输入 空间 的 离散 化 


在 参考 文献 [35.26] 中 ，Divelbiss 和 Wen 介绍 
了 一 种 非 完 整 移动 机 器 人 无 碰撞 避 开 障碍 的 可 行 性 路 
径 规划 。 他 们 由 傅 里 叶 理论 ， 限 制 子 空间 的 输入 函数 


在 现实 世界 中 主要 考虑 局 部 情况 。 在 这 种 情况 
下 ， 如 果 全 局 的 推理 是 必需 的 ， 情 况 可 能 会 非常 复 
杂 。 尽 管 如 此 ， 用 避 障 技术 来 处 理 未 知 的 和 不 断 变化 
的 环境 是 非常 必要 的 。 
值得 注意 的 是 ， 避 障 技术 已 发 展 到 将 全 局 避 障 和 


集 在 区 间 [0, 1] 内 。 因 此 ， 由 有 限 维 向 量 入 表示 
输入 函数 。 达 到 目标 构 型 成 为 解 一 个 非 线 性 方程 组 ， 
其 中 的 未 知 量 为 中 的 坐标 入 ;。 作 者 使 用 牛顿 迭代 
BERI. 障碍 是 指 构 型 空间 中 的 不 等 式 约束 。 该 路 
径 离 散 成 NN 个 采样 点 。 在 样本 点 范围 内 ， 这 些 无 碰 
E RE 量 的 不 等 式 约 束 。 通 过 函 
数 g 可 将 不 等 式 约束 转化 为 等 式 约束 ， 定 义 为 : 
(1-e)? c>0 
geo | 0 c<0 
因此 避 开 障碍 物 达 到 目标 构 型 ， 变 成 了 也 是 使 用 
牛顿 迭代 法 求解 非 线 性 系统 的 矢量 方程 问题 。 该 方法 
是 相对 有 效 的 快速 求解 方法 。 主 要 的 困难 是 要 调整 传 
里 叶 展 开 秩 序 。 在 杂乱 的 环境 进行 长 距离 运动 是 一 个 
高 阶 系统 ， 而 在 空旷 的 空间 运动 ， 可 以 由 一 个 低 阶 方 
程 解决 。 作 者 没有 提 到 在 动力 系统 积分 下 的 数值 不 稳 
定 问题 。 


35.6.3 ”基于 输入 的 快速 扩展 随机 树 


第 5 章 的 RRT 算法 可 用 于 无 局 部 路 径 规 划 方 案 
时 的 非 完 整 系统 的 路 径 规 划 。 在 一 段 时 间 里 ， 利 用 随 
机 输入 现 有 节点 可 以 产生 新 的 节点 ， 详 见 参考 文献 
[35. 27] 。 主 要 的 困难 在 于 找到 一 个 能 准确 表示 系统 
从 一 个 构 型 到 另 一 个 构 型 的 距离 函数 ， 此 外 ， 目 标 从 
来 都 不 可 能 准确 达到 。 后 者 可 以 利用 参考 文献 
[35.28] 讲述 的 路 径 变形 方法 最 后 处 理 返 回路 径 来 
解决 。 


35.7 从 路 和 


径 规 划 到 避 障 


到 目前 为 止 ， 我 们 已 经 讲述 了 一 些 运动 路 径 规划 
方法 。 目 的 是 要 计算 在 满足 车 辆 的 限制 规定 的 前 提 下 
达到 目标 构 型 的 无 磁 撞 轨迹 。 首 先 已 经 建立 了 一 个 机 
内 人 和 场景 的 完美 的 模型 。 这 些 方法 的 优点 是 提供 了 
全 局 路 径 规划 的 解决 方案 。 然 而 ， 当 周围 的 环境 是 未 
知 的 和 不 可 预测 的 ， 这 些 方 法 就 会 失效 。 
解决 路 径 规划 的 补充 方法 是 避 障 。 避 障 的 目标 是 
在 运动 中 ， 避 开 传 感 器 检测 到 的 障碍 从 而 无 碰撞 地 移 
动 到 目的 地 。 反 应 式 避 障 的 优点 是 引入 控制 回路 内 的 
传感器 信息 来 计算 路 径 ， 采 取 与 最 初 的 规划 不 符 的 应 
急 措 施 来 避 开 障碍 物 。 


ü 


局 部 避 障 相 结合 。 那 么 如 何 考虑 在 规划 层面 机 器 人 的 
观感 ? 这 就 是 所 谓 的 基于 传感器 的 运动 规划 。 现 在 已 
有 一 些 改 进 算法 ， 比 如 在 参考 文献 [35.29] 中 介绍 
的 BUG 算法 ， 但 这 些 算法 没有 考虑 非 完整 移动 机 器 
人 的 实际 情况 。 


35.8 REX 


令 A 为 在 空间 W 中 运动 的 一 机 器 人 (一 刚性 物 
体 ) ， 其 构 型 空间 为 CS。g 作为 一 个 构 型 ，g, 是 其 在 
t 时 刻 的 值 ， 且 机 器 人 在 这 种 构 型 下 占据 的 空间 
Alq) se 加 ,在 机 器 人 中 有 一 传感器 负责 在 构 型 9 中 


感知 机 器 人 周围 空间 S(4g ) CW， 用 以 识别 一 系列 的 
障碍 物 0(g,) CW. 
Qu 为 一 恒定 控制 向 量 ，x(g ) 为 构 型 g, 中 在 


8t 时 间 内 的 取 值 。 对 于 给 定 的 x(9g, ) ， 机 器 人 所 行进 
的 轨迹 为 : q, +ò =fu, q, t), (8:120), FQ > 
Aq, 经 时 间 间 隔 Bre [0, T] 后 续 轨迹 对 应 构 型 的 集 
合 ，7 >0 称 为 采样 周期 。 

4 F: CSx CSOR “为 从 一 个 构 型 到 另 一 构 型 的 
进展 评估 函数 。 

S qi 为 一 目标 构 型 。 那 么 ,在 1; 时间 内 ， 机 
TA A 在 9, 构 型 中 ， 此 时 传感器 感知 区 域 为 SCqg,) , 
障碍 物 描述 为 0(g,)。 我 们 的 目的 在 于 计算 出 一 个 
运动 控制 向 量 w, 使 得 : om 
EIS Az HE ETE, BD A (Q,, T) n0(q,) = 
@ 使 机 器 人 向 目标 位 置 行 进 ， 即 FC, s < 
P(g tT Mo) 

在 每 一 采样 周期 内 解决 这 一 问题 ， 就 是 要 在 运行 
期 间 根据 传感器 感知 的 避 障 信息 计算 出 一 系列 的 运动 
控制 向 量 ju,---u,}, WE 35. 8a 所 示 ， 同 时 在 每 一 
构 型 空间 Lg, equ 使 机 器 人 向 目标 移动 ， 如 图 
35. 8b 所 示 。 注意 机 器 人 的 移动 是 全 局 性 的 问题 而 
避 障 方式 是 局 部 的 问题 ， 是 利用 迭代 方法 来 处 理 避 障 
的 。 定 位 的 欠缺 和 在 控制 周期 内 得 到 传感器 信息 有 关 
(考虑 实际 操作 中 的 情况 ) 。 

有 三 个 方面 影响 着 机 器 人 避 障 方式 的 发 展 : 避 障 
技术 、 机 器 人 传感器 类 型 和 障碍 情景 。 这 些 方面 又 对 
应 着 以 下 三 种 情况 : 首先 ， 我 们 描述 避 障 技术 (35.9 
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节 ) ， 其 次 我 们 讨论 机 絮 人 能 够 适应 给 定 避 障 方式 的 
技术 ,要 考虑 到 障碍 物 的 形状 、 运 动 学 和 动力 学 
(35.10 15) 。 传 感 句 感知 信号 处 理 将 在 第 4 章 和 第 24 
章 详 细 阐 述 。 最 后 ， 在 特定 障碍 情景 下 ， 一 种 避 障 技 
术 在 机 右 人 上 主要 取决 于 障碍 物 的 性 质 (静态 或 动 
态 的 ,已 知 或 未 知 的 ， 有 组 织 或 没有 组 织 的 ， 或 者 是 


障碍 物 的 尺寸 等 )。 通 常 ， 这 一 问题 和 综合 设计 以 及 
避 障 有 关 (35. 11 节 )。 
未 知 空间 
目标 
e 
障碍 物 (O) 
移动 (U) 
Gaskin 
区 域 感知 (S) 


a) 


图 35.8 a) 当 机 器 人 朝 着 目标 位 置 移动 的 时 候 ， 避 障 

问题 就 是 通过 传感器 搜集 的 障碍 物 信息 ， 计 算 避 免 碰 

撞 的 运动 控制 b) 每 次 避 障 的 移动 就 形成 了 一 系列 使 
机 器 人 向 目标 靠近 的 运动 


35.9 RRR 


这 里 我 们 介绍 一 下 避 障 技术 的 分 类 以 及 具有 代表 
性 的 避 障 方式 ， 首 先 有 两 大 类 : 一 类 是 运动 计算 在 一 
步 中 ， 第 二 类 就 是 运动 计算 在 多 步 中 。 一 步 方式 直接 
降低 了 传感器 信息 对 运动 的 控制 。 下 面 为 其 两 种 
类 型 ; 

1) 启发 式 方法 是 第 一 个 应 用 于 依 笔 传 感 句 控制 


参考 文献 [35.33, 34] 讨论 势 场 方式 。 其 他 的 为 某 
BRAN BB E BUM ze $0079 s Ha HERUM 

多 步 模式 计算 一 些 中 间 信 息 ， 这 些 中 间 信 息 已 经 
处 理 得 几乎 能 得 到 运动 结果 了 。 

1) 子 集 控 制 模式 计算 一 系列 中 间 运 动 控制 ， 进 
而 选择 其 中 之 一 作为 控制 结果 。 可 分 两 种 类 型 : 
中 计算 运动 方向 子 集 模式 。 参 考 文献 [35.39] 讲 
述 了 向 量 空间 直方 图 ， 参 考 文献 [35.40] 讲述 了 
障碍 约束 模式 ， 另 外 一 种 模式 在 参考 文献 [35.41] 
GM, DR RE whl Fit sk, Be aR 
[35.42] 讲述 动态 窗口 方法 ， 参 考 文献 [35.43] 
讲述 了 障碍 物 速 度 计算 方法 ， 另 外 一 种 模式 是 基于 
类 似 规 则 但 独立 发 展 起 来 的 ， 即 曲线 速度 模式 ， 见 
参考 文献 [35.44]. 

2) 最 后 ， 还 有 一 些 模式 是 通过 计算 高 标准 的 信 
息 得 到 中 间 信 息 ， 再 把 这 种 中 间 信 息 转换 成 运动 控 
制 。 参 考 文献 [35.45, 46] 讲述 了 近似 图 标 导 航 
方法 。 

所 有 这 些 列 出 的 模式 都 存在 利弊 ， 这 取决 于 导航 
环境 ， 如 不 确定 的 障碍 情景 、 高 速 运动 、 在 限定 的 或 
混乱 的 空间 中 运动 等 。 不 幸 的 是 没有 行 之 有 效 的 衡量 
某 一 模式 质量 的 标准 ， 然 而 ， 参 考 文献 【35.45] 中 
可 以 看 到 这 些 模式 本 质问 题 的 实验 对 比 。 


35.9.1 势 场 模式 


势 场 模式 运用 一 种 类 比方 式 ， 这 里 机 器 人 就 像 一 
粒 微粒 受 力 场 作 用 在 构 型 空间 中 和 运动， 同时 目标 位 置 
向 机 器 人 微粒 施加 引力 Ff ， 障 碍 物 向 机 器 人 微粒 施 
加 斥 力 F,,，。 在 每 一 时 间 1;,， 机 器 人 是 沿 上 面 两 种 假 
和 象 力 的 合力 Faq) =Fan (Gi) +E) 方向 移动 
(最 为 理想 的 方向 ) ， 如 图 35. 9 所 示 。 


例 35.2. 
F,(q,) TE, e (35. 9) 
1 1 
Ki pa low Uy t, d( t; 9. ,)<d 
F, (4) irr a TENUES 
0 其 他 
(35.10) 


SUP, Kus Ke DEER; dy Je BL tie AORE Bi ft 
物 p 的 距离 ，g, 为 机 器 人 当前 构 型 ， Boss n, 分 别 
为 从 q, 指 向 目标 和 每 个 障碍 物 p, 的 矢量 ,借助 FS 
(g,,)， 通 过 位 置 或 力 的 控制 便 可 得 到 u, BESA 


运动 的 方式 ， 主 要 起 源 于 经 典 规划 方式 ， 这 里 不 再 讨 
论 ， 详 细 情 况 可 参看 参考 文献 [35.1, 29-32], 
2) 物理 类 比 的 方式 是 把 避 障 类 比 为 物理 问题 。 


参考 文献 [35.47], 
这 是 经 典 模型 ， 其 中 的 势 场 仅 取决 于 机 右 人 的 当 
前 构 型 。 作 为 补充 的 情况 是 广义 的 势 场 ， 这 种 势 场 还 
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图 35.9 a) 利用 势 场 方法 计算 运动 方向 。 


目标 对 机 器 

人 施加 引力 Fa 而 障碍 物 对 机 器 人 施加 斥 力 F uus HEAD 

下 io 的 方向 为 机 器 人 和 避 障 运动 最 理想 的 方向 b ) 空间 各 
点 经 典 方法 计算 所 得 的 运动 方向 


受 瞬 息 万 变 的 机 器 人 速度 和 加 速度 影响 。 
例 35.3: 


K o m sd 
wp = 7 * 
0, 其 他 
(35.11) 
RP, ,为 机 器 人 当前 的 速度 ; n ,为 机 器 人 速度 
方向 向 量 ; a 为 机 器 人 最 大 加 速度 。 当 把 排斥 势 场 定 
义 为 机 器 人 碰撞 障碍 物 之 前 的 估计 时 间 和 机 器 人 达到 
最 大 后 退 加 速度 前 停止 机 器 人 所 需 的 时 间 颠 倒 时 ， 这 
个 表达 式 就 起 作用 了 。 注 意 这 里 的 斥 力 只 对 机 器 人 的 
移动 方向 起 作用 ， 这 和 经 典 势 场 截然 不 同 的 。 经 典 势 
场 和 这 种 广义 势 场 的 比较 以 及 其 与 计算 运动 控制 的 关 
系 可 以 参看 参考 文献 [35.47] 。 这 种 方法 因为 其 易 
于 理解 以 及 清晰 的 数学 表达 式 而 被 广泛 应 用 。 


35.9.2 向量 场 直方 图 


向 量 场 直方 图 (VFH) 方法 分 两 步 解决 这 一 问 
题 ， 即 计算 备 选 运动 方向 集合 然后 再 在 这 些 方向 中 选 


HU 


择 一 个 。 

1. 方向 的 候选 集合 

首先 ， 从 机 器 人 位 置 将 空间 分 成 多 个 扇形 区 域 ， 
这 种 方法 就 是 在 机 器 人 周围 构建 极 坐 标 直方 图 万 ， 其 
中 每 个 部 分 表示 障碍 物 在 相应 扇形 区 域 的 极 性 密度 ， 
表示 出 障碍 物 在 肩 区 上 中 分 布 对 应 部 分 的 直方 图 
h Cq) 的 函数 表达 式 为 


k EN n d(q,,,P) ) 
h (gq,) = [P (ı des dp 


(35. 12) 

TRAY FIR Q, = |peW\ pekAd(q,, p)«d,i, 
SERE h^ (qu). 正比 于 障碍 物 占据 某 一 点 的 概率 PCT) , 
且 随 着 距 此 点 距离 的 减少 而 增加 (两 个 函数 由 一 些 
整数 驱动， 其 中 + >0)。 

通常 所 得 的 直方 图 有 峰值 (高 密度 障碍 物 的 方 
向 ) 和 低谷 ( 低 密度 方向 ) ， 候 选 方向 集合 是 相 邻 部 
分 的 集合 ， 这 些 部 分 具有 上 比 给 定 阔 值 更 低 的 障碍 物 密 
度 ， 且 最 靠近 包含 目标 方向 的 部 分 。 称 这 些 部 分 
CHK) 的 集合 为 可 选择 的 低谷 ， 并 表示 候选 方向 的 
集合 ， 如 图 35. 10 所 示 。 

2. 运动 计算 

下 一 步 的 目标 是 在 这 个 集合 中 选择 


个 方向 ， 其 
思想 就 是 三 个 依赖 于 包含 目标 的 部 分 或 已 选 低谷 的 大 
小 启发 式 方法 。 几 种 情况 检测 如 下 : 

1) 情况 1: 目标 扇 区 在 已 选 低谷 中 。 处 理 办 法 : 
ka = kagar kaga JUR BEME NSA K 

2) 情况 2: 目标 扇 区 不 在 已 选 的 低谷 中 ， 且 低 


谷中 的 扇 区 数 大 于 mm。 处 理 办 法 : E, ok t2, mH 
确定 的 扇 区 数 ， 帮 为 低谷 中 最 靠近 目标 的 扇 区 。 
3) 情况 3: 目标 扇 区 不 在 已 选 的 低谷 中 ， 且 低 


k. +k. 
谷中 的 肩 区 数 不 大 于 六 。 处 理 办 法 : hy = 


ai 
fy Fa ORSON EH AS BX 

MESE kK, HORSYRBLEIT I Ogo 速度 
wx 与 机 器 人 和 最 近 障碍 物 之 间距 离 成 反比 。 所 以 得 
到 控制 向 量 为 : w= Was Oy) 

VEH 方法 将 障碍 物 的 分 布 可 能 性 公式 化 地 表达 
出 来 ， 因 此 很 好 地 适应 于 不 同 传感器 的 障碍 物 识 别 ， 
如 超声 波 传感器 等。 


35.9.3 ”障碍 约束 法 


用 障碍 约束 法 (ORM) 解决 问题 分 三 步 走 ， 前 
两 步 的 结果 是 机 器 人 运动 方向 的 候选 集 。 第 一 步 要 计 
算出 一 个 瞬时 的 子 目 标 ， 如 果 必 要 的 话 。 接 着 第 二 步 


k, 


i? 
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sot 


目标 
9 


$ 选 定 的 方向 
a) 


Ktarget 


候选 低谷 


270° Jd [X 


图 35. 10 使 用 VFH 方法 计算 运动 方向 9.， 
a) 机 器 人 和 障碍 物 位 置 分 布 b) 候选 低谷 为 具有 比 
阔 值 更 低 的 邻近 部 分 的 集合 ( 因为 目标 区 域 Ki 不 在 
峡谷 中 且 扇 区 数目 小 于 确定 数 痛 (于 =8， 即 ，45?") ， 
所 以 符合 情况 3。 困 此 有 e s pO a) 


中 的 OL. kis ky 的 平分 线 分 别 为 9;，9;) 


将 每 一 个 障碍 物 和 每 一 个 运动 约束 结合 起 来 ， 结 合 他 
们 进一步 来 计算 他 们 理想 方向 的 集合 。 最 后 一 步 是 用 
该 策略 来 计算 给 定 集 的 运动 。 

1. 瞬时 目标 选择 

这 一 步 计算 子 目标 时 ， 最 好 的 办 法 就 是 直接 向 给 
定 空间 区 域 运动 (改善 条 件 以 实现 目标 后 ) ， 而 不 是 
直接 向 目标 本 身 。 这 个 子 目 标 位 于 障碍 物 的 中 间或 障 
得 物 的 边缘 〈( 见 图 35. 11a) 。 接 下 来 ， 用 局 域 算 法 来 
检查 这 个 过 程 是 否 可 以 从 该 机 器 人 的 位 置 来 获得 目 
标 。 如 果 不 能 ， 则 选择 距 目 标 最 近 的 可 到 达 的 子 目 
标 。 为 了 检查 是 否 有 一 个 这 样 的 点 可 以 到 达 ， 有 一 个 
局 域 算 法 可 以 用 来 计算 连接 这 两 个 位 置 的 局 部 路 径 的 


存在 性 56554631 ， 


目标 


b) 


图 35.11 a) 子 目标 x; 的 分 布 。 选取 的 瞬时 目标 

位 置 为 x, 。 候选 方向 的 集合 是 S$,,， 解决 方法 是 0, 

(第 二 种 情况 ) b) 对 给 定 的 障碍 ， 两 个 不 理想 
方向 的 集合 S| AS, 


设 x, 和 ,为 空间 中 的 两 个 位 置 ，R 为 机 器 人 的 半 
径 , 工 为 障碍 物 点 列表 ， 其 中 jp; 为 该 点 列表 中 的 一 个 
障碍 物 。 令 A 和 B 分 别 表示 被 x, 和 x, 连 接 的 直线 所 
分 割 的 两 个 半 平 面 。 若 对 于 工 中 的 所 有 点 都 有 d(p,, 
p,) >2R (CH p, € A, p, e B)， 则 存在 一 个 免 碰撞 
路 径 连 接着 这 两 个 位 置 。 如 果 该 条 件 不 满足 ， 则 不 存 
在 这 样 的 局 域 路 径 (即使 存在 这 样 的 一 个 全 局 路 
径 ) 。 这 个 有 意义 的 结论 就 是 当 结 果 是 正 的 时 候 ， 可 
以 保证 一 点 能 够 到 达 其 他 存在 的 点 。 
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过 程 的 结果 是 他 们 的 目标 或 一 个 瞬时 的 子 目 

标 We 标 位 置 ) 。 注 意 到 这 
一 过 程 的 一 般 性 以 及 可 作为 预 处 理 步骤 用 其 他 方式 来 
立即 验证 目标 定位 或 去 计算 一 个 瞬时 的 子 目标 来 驱动 
机 器 人 。 

2. 方向 候选 集 

对 每 一 个 障碍 物 i， 不 理想 的 运动 方向 集合 S5, 
(运动 约束 ) 被 计算 出 来 。 这 个 集合 是 两 个 子 集 SCRI 
S 的 并 集 。3$: 表 示 不 适合 躲避 的 障碍 物 的 那 一 侧 ，$ 
表示 障碍 物 所 包围 的 禁区 ( 见 图 35. 11b) 。 障 碍 物 的 
运动 约束 是 这 两 个 集合 的 并 集 S^, =S, US), PERI 
运动 方向 集合 就 是 他 们 的 补 集 

Sp ={[ -—m.m]\dS,,} ,这 里 Sn = Usno 

3. 运动 计算 

最 后 一 步 是 选择 运动 的 方向 。 ue 设 定 的 理想 方 
向 $, 和 目标 方向 ,分 三 种 情况 ， 这 三 种 情况 依 
次 为 

1) 情况 1: 


target 


S,70 H0 Sy, f Ut Uri: 


target € 


2) 情况 2: S 关中 且 gs Sp, MRN: 
0,, = Oimn XXI 0, 为 最 靠近 6。 的 5, 的 方向 。 
dank. 0, = m p 
这 里 bw 和 bm 分 别 是 较 接近 bw 的 Sp, 和 Sp, 的 方向 
(Sn 和 Sn 分 别 是 在 目标 左 侧 和 右 侧 的 障碍 物理 想 方 
向 上 的 集合 ) 。 

其 结果 就 是 解决 方案 0., 的 运动 方向 。 速 度 wy 与 
最 近 障 碍 的 距离 成 反比 。 该 控件 是 到 (vu, 0,4). 

这 是 一 个 基于 不 同情 况 的 几何 算法 。 优 点 是 证 实 
了 在 有 限 空 间 内 可 以 有 效 运动 。 


35.9.4 动态 窗口 法 


动态 窗口 法 (DWA) 分 两 个 步骤 来 解决 问题 ， 
作为 中 介 信 息 来 计算 控制 空间 u 的 一 个 子 集 。 简 单 
来 说 ,我们 把 运动 控制 看 做 平移 和 转动 速度 (>， 
e). U 被 定义 为 

={(v,0) eR^we[ -v, 
e[ -o, 

1. 候选 控制 集 
控制 候选 集 Ui 包括 : 中 车 辆 最 大 速度 内 的 控 
制 U; @@ 产 生 安全 轨迹 的 控制 U @ 在 给 定 加 速 
度 的 情况 下 ， 可 以 在 很 短 的 一 段 时 间 内 达到 的 控 
fi] Up RE UV, 包含 可 采纳 的 控制 。 通 过 利用 最 大 
负 加 速度 (a,, a,), 这 些 控 制 可 以 在 碰撞 前 


3) 情况 3: S7, 


max ?" max 


(35.13) 


EO, 


撤销 : 
=| (wo) €U|vs dpa, NOS Vda 
(35.14) 
WP, dy 和 0 分别 表示 距离 障碍 的 距离 和 越过 障碍 
的 轨迹 的 切线 方向 。 集 合 UV, 包含 在 很 短 时间 内 可 达 
到 的 控制 
Uy =1(v,@) eUWwe[v, -a,T,vo +4,T| ^v 


€[@ -a,T,c, *a,T]| (35.15) 
Xm, q,7 (%, wo ) 表示 流速 。 
产生 的 控制 子 集 是 (图 35. 12): 
U, =UNU, NU, (35.16) 
Wmax 


—Umax Umax 


当前 速度 


(vo, Wo) 


图 35. 12 控制 子 集 Us = UN Us nvUb， 这 里 U ERE 
大 速度 内 的 控制 ，U 表示 可 采纳 的 控制 ，U 在 很 短 
时 间 内 可 达到 的 控制 


2. 运动 计算 
接 下 来 的 步骤 是 选择 一 个 控制 U,e VU。 阐述 这 
个 问题 可 转化 为 目标 函数 最 大 化 的 问题 


G(U) =a, * Goal(U) +a, * Clearance(U) 
a, * Velocity( U) 
(35.17) 
这 个 函数 是 Goal (U) 中 的 一 个 折 中 型 函数 ， 


Goal(U) 表示 向 目标 提供 进展 的 速度 ，Clearance( U) 
为 远离 障碍 物 的 速度 ，Velocity(U) 表示 高 速 。 解 决 
的 办 法 是 控制 U;， 使 该 函数 最 大 。 

DWA 是 在 控制 空间 内 使 用 车 辆 动力 学 信息 来 解 
决 问题 的 ， 因 此 该 算法 也 很 好 地 适用 于 工作 在 缓慢 动 
态 性 能 的 或 高 速 的 车 辆 上 。 
35.9.5 速度 障碍 

用 速度 障碍 (VO) 法 解决 问题 分 两 步 走 ， 通 过 
计算 作为 中 介 信 息 U 的 一 个 子 集 。 其 框架 类 似 于 


DWA 法 。 不 同 的 是 ， 安 全 轨迹 的 集合 UV, 计 算 考 虑 了 
障碍 的 速度 ， 这 个 问题 接 下 来 进行 描述 。 
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令 表示 障碍 i 的 速度 ( 车辆 半径 伸 长 后 所 占 区 这 种 方法 的 优点 是 考虑 了 障碍 的 速度 ， 因 此 很 适 
域 为 B,) ,U0U 为 给 定 的 车 辆 控制 。 碰 撞 相对 速度 的 集 ” 合 于 动态 情况 。 
合 我 们 称 为 碰撞 锥 EAM E ESSE 
ee er eer 35.9.6 ”近似 图 导航 
这 里 A, 表示 单位 向 量 U, =U, -v, 的 方向 。 速 度 该 算法 是 一 个 设计 避 障 方法 的 方法 论 ， 而 不 仅 
障碍 设置 在 一 个 共同 绝对 的 参考 系 中 仅 是 算法 本 身 。 按 照 这 一 方法 论 , 近似 图 导航 
VO, = CC, v, (35.19) — (ND) 是 一 个 基于 几何 应 用 的 避 障 法 。 这 种 做 法 背 


这 里 由 表示 明科 夫 斯 基 矢 量 和 。 非 安全 轨迹 的 集 ”后 的 思想 是 采用 分 而 治之 的 策略 ， 根 据 设 定 条 件 的 
合 是 针对 于 每 一 个 移动 障碍 的 速度 障碍 的 并 集 U, = 活动 模式 以 简化 避 障 问题 条 件 为 基础 ( 见 参考 文献 
U,VO, (图 35. 13) 。 [35.48] 的 评论 ) 。 首 先 ， 存 在 能 代表 了 所 有 机 器 
人 之 间 的 位 置 、 障 碍 与 目标 位 置 的 一 系列 情形 ， 还 
有 与 每 一 种 情形 相对 应 的 运动 规律 。 在 执行 阶段 ， 
在 时 间 t;,， 若 一 种 情形 被 确定 ， 其 相应 的 规律 用 来 
计算 运动 。 

1. 情形 

情形 用 二 元 决策 树 来 表示 。 情 形 的 选取 依赖 障碍 
W 0(q,) , 机 器 人 的 位 置 gq, 以 及 目标 qs。 标 准 基 
于 高 层次 实体 ， 如 机 器 人 边界 和 运动 区 域 周 边 的 安全 
距离 〈 即 确定 适当 的 运动 区 域 ) ， 例 如 ， 有 这 样 一 个 
标准 : 看 在 安全 区 域内 是 否 有 障碍 。 另 一 种 情形 是 运 
动 区 域 是 大 还 是 罕 。 结 果 仅 有 一 种 情况 ， 因 为 根据 定 
义 和 表 示 (二 元 决定 树 )， 这 些 情况 是 完整 而 排他 的 
( 见 图 35. 14) 。 


图 35.13 不 安全 控制 子 集 0 -VO,UVO,. 对 于 移动 
的 障碍 ， 超 出 该 集合 的 控制 矢量 产生 非 磁 撞 运 动 


情形 行动 
决策 树 


"METTUS b) 


图 35.14 a) 方法 设计 图 。 给 定 障碍 信息 及 目标 信息 ， 在 给 定 的 一 个 标准 下 就 可 以 识别 出 一 种 情形 。 紧 接 着 ， 相 关 

的 行为 被 执行 ， 来 计算 运动 b) ND 解决 方法 的 计算 示例 (几何 应 用 ) 。 第 一 步 是 确定 情况 。 没有 比 安全 距离 D, 更 

近 的 障碍 。 接 下 来 9 uset 不 在 运动 区 域内 。 第 三 ， 运 动 区 域 是 宽 的 。 鉴于 这 三 个 标准 我 们 确定 当前 的 情况 ， 

HSWR。 在 这 种 情况 下 ， 相 应 的 行为 计算 控制 wi = (zsu,bsu) ， 这 里 vo 是 最 大 速度 ，0,。 被 计算 为 从 更 接近 目标 的 方向 
运动 区 域 极限 方向 6, 的 偏差 a 
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2. 行动 

对 于 每 一 种 情形 都 存在 一 个 行动 来 计算 运动 从 
而 采取 相应 的 行为 以 适应 每 一 种 情形 所 代表 的 情况 。 
在 高 水 平 上 ,行动 描述 每 一 种 情况 所 需 的 行为 ， 例 
如 ， 有 这 样 一 种 情况 ， 当 安全 区 域内 没有 障碍 且 目 
标 就 在 运动 区 域内 (HSGR)。 方法 就 是 朝 目 标 运 
动 。 男 一 种 情况 是 ， 当 在 安全 区 域内 没有 障碍 日 


前 的 速度 d, = (wv ，@o) ， 可 达到 的 控制 集 U0, 及 最 大 
加 速度 (a,，a。) 可 通过 式 (35.15) 得 到 。 

1. 抽象 结构 

对 于 这 个 机 器 人 ， 它 的 构 型 空间 CS 是 三 维 空 
间 。 其 思想 是 构造 一 个 由 基本 的 圆周 路 径 定义 ARM 
(q,) =ARM 构 型 空间 的 流 形 ， 以 每 一 时 刻 4, 的 机 器 
人 位 置 为 中 心 。 定 义 流 形 的 函数 是 


目标 不 在 运动 区 域内 但 很 宽 (HSWR ) 。 方 法 是 朝 
运动 区 域 的 边界 线 移动 ， 但 要 清查 还 有 障碍 的 安 
全 域 。 

这 种 方法 有 趣 的 一 面 是 ， 它 采用 了 分 而 治之 的 策 
略 来 解决 导航 ， 从 而 简化 了 问题 。 第 一 个 优势 是 ， 该 
算法 是 在 象征 性 的 水 平 上 描述 的 ， 因 此 有 很 多 方法 可 
以 实现 该 算法 。 第 二 ， 这 一 方法 论 的 几何 实施 (ND 
法 ) 已 被 证 实 可 以 在 密集 、 复 杂 和 困难 的 情况 下 将 
困难 航行 问题 转化 为 安全 航行 。 


35.10 ” 避 障 中 机 器 人 的 外 形 特 征 、 运 
动 学 和 动力 学 


在 避 障 过 程 中 ， 对 于 车 辆 需要 考虑 三 个 方面 的 问 
题 : 形状 特征 、 运 动 学 和 动力 学 。 这 个 形状 特征 和 运 
动 学 共同 形成 一 个 几何 问题 ， 涉 及 车 辆 在 给 定 的 轨迹 
Q, ,碰撞 中 的 构 型 表示 。 动 力学 考虑 了 加 速度 和 时 间 
问题 ， 包 括 两 个 方面 : 中 在 给 定 当 前 速度 4 ,及 最 大 
加 速度 的 条 件 下 在 短 时 间 段 了 内 选择 一 个 可 达到 的 控 
制 ; @ 把 制 动 距离 考虑 进去 ， 这 样 当 控制 执行 后 ， 在 
应 用 最 大 加 速度 时 车 辆 在 碰撞 前 可 以 一 直 保 持 不 动 
(改善 了 安全 性 ) 。 

在 避 障 时 关于 形状 特征 、 运 动 学 和 动力 学 的 问题 
我 们 从 三 个 不 同 的 方面 来 考虑 : 中 设计 一 种 可 以 将 约 
束 融 和 人 到 算法 中 的 一 个 方法 (35.9.4 5); ODMAH 
RH W Jii E JT WEE E M dl S [E DA] BE ARO PP! ，; 
@ 借 助 技 术 将 问题 分 解 成 一 些 子 问 题 ， 青 通过 使 用 算 
法 将 各 个 方面 按 顺 序 ”- 引 依 次 合并 。 


35.10.1 抽象 车 辆 方面 的 技术 


这 些 技术 是 基于 在 车 辆 方面 及 避 障 算法 之 间 构 造 
一 个 抽象 屋 ， 以 此 ， 当 算法 一 旦 被 采用 ， 解 决 方案 就 
已 考虑 到 了 各 个 方面 ”1 。 这 里 我 们 考虑 在 常量 
控制 下 所 得 到 的 基本 路 径 下 的 车 辆 可 以 通过 圆 弧 来 近 
似 佑 计 〈 例 如 一 个 差 速 驱 动机 器 人 ， 一 个 同步 驱动 
机 器 人 或 一 个 三 轮 车 ) 。 为 简化 分 析 ， 我 们 提出 控制 
就 是 一 个 平移 的 和 转动 的 速度 = (v, e). ES 


2-5 
Ec. 


arctan2 ( x , y20 
2y 
@=flx,y) = -_ 
— arctan? (x, = ) 其 他 
2y 
(35.20) 


很 容易 看 到 函数 /在 空间 R”\ (0, 0) 上 是 可 微 
的 。 因 此 , 24 (x, y) eR’?*\ (0,0) 时 (x,y,f 
(x, y)) 在 R?xS' 上 定义 了 一 个 二 维 的 流 形 。 这 个 
流 形 ARM 包含 了 在 每 一 步 避 障 中 的 所 有 构 型 。 

接 下 来 ,在 ARM 中 ， 人 们 可 根据 任意 形状 的 机 
器 人 中 给 出 的 碰撞 域 CO 〈 例 如 流 形 中 障碍 的 表 
示 ) 计算 这 一 障碍 的 确切 位 置 ， 给 一 个 障碍 点 (x, 
y,) 和 一 个 机 器 人 活动 域 (x,，y,) ，COw 域 中 的 点 
(x,, y) 可 按 下 式 计 算 

E E (x,*x;)a 
y," (y,-y)a 


(35.21) 


Crp, 
OR- + OF x) Cy yi)? + Gg; 7x7] 

Gy -»)* *2(2; tx)G-y) + (x7 二 

这 一 结果 用 来 绘制 机 器 人 避 开 所 有 多 样 化 障碍 物 
边界 的 地 图 ， 以 此 来 确切 地 计算 CO, BEAR, BET 
来 ， 在 多 样 化 ARM 中 计算 非 容许 构 型 CAN S, DS 
在 这 个 构 型 空间 中 机 右 人 一 旦 在 时 间 7 达 到 了 给 定 的 
速度 ， 则 它 不 能 采用 无 碰撞 最 大 负 加 速度 停止 〈 即 
没有 足够 的 制 动 距 离 ) CNA sey BO DC ERE CO, uu dn JE 
的 部 分 ， 是 由 机 器 人 的 最 大 加 速度 而 定 。 可 在 短期 时 
间 UV, 通过 控制 可 达 性 ， 可 达到 的 构 型 集 RC, py BEE 
ARM 中 计算 得 出 的 。 最 后 ， 对 ARM 进行 坐标 变换 得 
到 ARM"*， 其 作用 是 将 流 形 中 的 一 般 的 圆 形 路 径 变 成 
直线 路 径 。 结 果 现 在 问题 变 为 在 无 约束 的 二 维 空间 中 
可 向 任意 方向 点 移动 。 

2. 方法 应 用 

最 后 一 步 是 将 避 障 方法 应 用 在 ARM? 中 以 避免 
CNA’ ru ARo AIRNE B aE ARM PARA A 
望 的 方向 。 这 个 方向 也 被 用 来 在 给 定 的 动态 可 达 
RCiru 构 型 集中 选择 一 个 qla e CNA ATA FT ALE. He 
后 通过 控制 wj 在 时 间 T 时 刻 到 达 这 一 位 置 。 通 过 构 
造 ， 这 种 运动 学 和 动力 学 允许 的 控制 避免 了 已 知 形状 
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车 辆 的 碰撞 并 考虑 到 制 动 距离 〈( 见 图 35. 15) 。 

如 图 35.15 BAN, FER APR ANE, 障碍 看 做 
ARM? 空 间 中 的 不 接受 区 域 CNAjw 且 运动 是 全 方向 的 
(许多 避 障 算法 的 适应 条 件 ) 。 算 法 被 用 来 获得 最 有 
发 展 希望 的 方向 B.,， 及 被 用 来 获取 在 可 到 达 构 型 集 
合 RCsw 里 的 构 型 方案 gs。 最 后 ， 解 决 方法 就 是 在 
时 间 了 完成 该 构 型 的 控制 &,。 这 个 控件 符合 运动 学 
和 动力 学 并 考虑 到 了 具体 车 辆 的 形状 特性 。 


3 o 
2 0 o 
Y RCanw 
o 目标 
1 o a o @ 


(vo, wo) 


B CNA ey H Ha, 


三 
图 35. 15 a) 机 器 人 位 置 、 障 碍 信息 以 及 目标 位 置 
b ) ARM? 空间 的 抽象 层 


注意 到 如 何 用 这 些 技术 将 三 维 的 避 障 问题 转变 为 
一 个 简单 的 二 维 空间 内 的 点 移动 问题 ， 而 没有 运动 学 
和 动力 学 的 限制 (很 多 现 有 方法 的 适用 条 件 )。 结 


步 数 | 第! 步 | 第 2 步 E 

[ Vo. | 环形 的 运 ， 第 形 的 运 | 
机 器 人 方面 EENE | 动 学 和 动 | 动 学 和 动 
有 
子 问题 | e 移动 控 Ly BARB 
cen) | RP a ee 


图 35. 16 ”分解 避 障 问题 成 为 逐步 子 问题 ， 依 次 嵌入 
到 机 器 人 中 


1. Rp 

首先 ， 避 障 方法 是 使 用 假设 为 圆 形 和 全 方位 的 机 
器 人 。 解 决 的 方案 是 最 有 和 希望 的 运动 方向 和 速度 z = 
(vi ，01) 引导 机 器 人 朝向 目标 。 

2. 运动 学 和 动力 学 
其 次 ， 这 种 控制 被 转变 为 运动 学 与 动力 学 相 结合 
的 控制 ， 从 而 容易 排列 在 瞬时 方向 9, 上 以 速度 wu 运 
动车 辆 ， 例 如 参考 文献 [35. 52，53 ] 通过 反馈 调整 
了 避 障 方法 的 输出 ， 使 得 机 器 人 在 最 小 二 乘 方式 下 与 
解 的 方向 保持 一 致 ， 参 考 文献 [35.51] 在 机 器 人 中 
使 用 了 一 个 动态 控制 器 。 该 控制 器 使 机 器 人 的 行为 模 
式 化 ， 好 像 用 一 个 虚拟 力 拉 机 器 人 ， 并 计算 在 很 短 的 
时 间 内 应 用 这 个 力 拉 的 运动 结果 。 由 此 产生 的 运动 是 
一 种 新 的 控制 。 为 了 使 用 该 控制 器 ， 先 前 的 控制 u, 
被 转化 为 瞬 态 力 = (^. 输入 控制 器 中 ， 
计算 出 一 个 妈 来 满足 运动 学 和 动力 学 。 

3. 形状 

最 后 一 步 是 要 确保 控制 到 来 获得 先前 的 效果 ， 
以 此 来 避免 了 该 机 器 人 与 确切 形状 相 磁 。 要 做 到 这 一 
点 ， 形 状 校正 器 需要 用 控制 的 动态 仿真 来 检查 碰撞 。 
如 果 存 在 一 个 碰撞 ， 可 达 控 制 器 的 集合 式 (35.15) 
将 产生 作用 直到 发 现 无 碰撞 控制 为 止 。 这 一 过 程 的 结 
果 是 产生 一 个 运动 控制 由， 保证 避 障 同时 考虑 机 器 
人 的 运动 学 与 动力 学 。 


整合 规划 一 反应 


35. 11 


在 本 节 中 我 们 将 展示 如 何 将 避 障 方法 结合 到 一 个 


果 ， 许 多 现 有 的 方法 可 以 适用 于 这 种 抽象 条 件 下 ， 因 
此 在 解决 的 方案 中 考虑 了 机 器 人 的 约束 。 


35. 10. 2 ” 子 问 题 的 分 解 技巧 


这 些 技巧 论述 了 避 障 问题 ， 并 将 其 分 解 为 各 个 子 
问题 : OR, @ 运 动 学 和 动力 学 ; OER, BT 
问题 依次 处 理 ( 见 图 35. 16 ) 。 


真正 的 系统 当中 。 一 方面 ， 避 障 方法 是 局 部 方法 来 解 
决 运动 问题 。 所 以 ,他 们 必 将 陷入 局 部 最 小 值 ， 要 人 么 
陷入 到 一 个 固定 的 位 置 或 是 做 周期 运动 。 这 也 表明 更 
多 全 局 推理 的 必要 性 。 男 一 方面 ， 运 动 规划 方法 计算 
一 个 无 碰撞 的 几何 路 径 ， 以 此 来 保证 全 局 收敛 。 然 
而 ， 当 环境 未 知 或 是 发 生 改变 时 ， 这 些 方法 都 将 不 起 
作用 ， 因 为 预先 计算 的 路 径 几 乎 肯定 会 与 障碍 发 生 碰 


9835 章 ， 运动 规 划 和 避 障 323 


撞 。 这 似乎 很 清楚 了 ， 建 立 一 个 运动 系统 的 一 个 关键 
环节 ， 是 结合 两 个 最 好 方面 : 由 运动 规划 给 出 全 局 的 
知识 而 避 障 方法 给 出 反应 。 

最 通常 的 方式 是 具体 指出 慎 思 与 反应 之 间 的 相互 关 
A: 中 预先 计算 到 目标 的 路 径 ， 然 后 将 其 转变 为 一 个 函 
数 作为 执行 函数 ， 这 一 函数 随 着 周围 监测 传感器 信息 的 
变化 而 变化 ， 例 如 在 参考 文献 [35.54-56] 中 提 到 的 路 
径 变 形 系统 ; @) 为 了 将 这 一 规划 在 带 有 战略 性 的 高 频 中 
应 用 ， 为 反应 器 的 执行 过 程 中 预 留 一 定 的 裕 度 57 9 。 


35.11.1 路 径 变形 系统 


松紧 带 方法 最 初 假定 到 目标 位 置 存 在 一 条 几何 路 
径 (由 规划 器 计算 )。 该 路 径 是 一 个 区 域 带 ， 这 个 带 
受到 两 个 类 型 的 力 的 影响 : 一 个 内 部 收缩 力 和 一 个 外 
力 。 内 力 模 拟 一 个 张力 带 来 维持 压力 。 障 碍 物 施 加 的 
外 力 使 这 个 带 远离 他 们 。 在 执行 过 程 中 ， 新 的 障碍 产 
生 力 来 使 这 个 路 径 带 远离 它们 ， 来 保证 他 们 的 避 障 。 
这 些 方法 在 这 本 书 的 第 5 章 中 已 说 明 。 

一 种 扩展 的 路 径 变 形 方 法 在 非 完 整 系统 于 5 中 
已 经 提出 了 。 尽 管 对 于 没有 运动 学 限制 的 移动 机 右 人 
目标 是 相同 的 〈 沿 轨迹 避 障 ) ， 但 是 概念 完全 不 同 。 
非 完 整 系统 的 轨迹 厂 完 全 是 由 初始 构 型 矿 (0) f 
MueCU, R”) 的 输入 值 确定 的 ,在 这 里 了 是 一 
个 间隔 。 因 此 ， 对 于 非 完 整 系统 的 轨迹 变形 方法 是 以 
当前 轨迹 输入 函数 扰动 为 基础 ， 以 实现 三 个 目标 : 

1) 保持 满意 的 非 完 整 约束 。 

2) 通过 便携 式 传感器 在 线 摆脱 检测 到 的 障碍 物 。 

3) 保持 变形 后 轨迹 最 初 和 最 后 的 构 型 不 变 。 

输入 函数 一 的 干扰 ， 由 一 个 向 量 值 输入 扰动 ze 
C (I, R”) 产生 轨迹 变形 me C(I, R^) 

uu+Ttv TT +T (35. 22) 
HP, 7 是 一 个 无 穷 小 的 正 实数 。 作 为 一 阶 近 似 ,， u 
和 ”两 者 的 关系 由 线性 化 系统 给 出 ， 在 这 里 不 再 给 
出 其 表达 式 。 

1. 障碍 势 场 

障碍 是 通过 在 构 型 空间 中 定义 一 个 潜在 的 势 场 来 检 
测 的 ， 当 机 器 人 靠近 障碍 时 这 个 势 场 就 增强 。 这 个 潜在 的 
势 场 被 提升 到 由 构 型 潜在 值 轨迹 所 整合 成 的 轨迹 空间 中 。 

2. 输入 空间 的 离散 化 

输入 扰动 空间 C (I, R”) 是 一 个 有 限 维 的 矢量 空 
间 。 一 个 输入 扰动 的 选择 被 限制 在 一 个 有 限 维 子 空间 
内 ， 包含 p ME EAM ik PRK, €,, 77, €,, HP p 是 一 
个 下 整数。 因此 一 个 输入 的 微小 扰动 x = ^ Ae h 
矢量 A ER? 来 定义 。 轨 迹 势 能 是 关于 入 线性 变化 的 。 


3. 边界 条 件 

边界 条 件 是 由 在 间隔 了 的 两 端 应 用 等 于 零 的 轨迹 
扰动 构成 的 ， 其 中 间隔 了 是 关于 和 线性 的 。 因 此 ， 不 
难 发 现 一 个 向 量 入 ， 它 可 使 势 场 下 降 并 满足 边界 条 件 。 

4. 非 完 整 约束 偏差 

输入 微 扰 与 轨迹 变形 之 间 的 近似 一 阶 关系 引起 了 
一 个 副作用 : 经 过 几 次 的 迭代 后 ， 非 完整 约束 条 件 不 
再 满足 。 这 个 副作用 可 通过 增 广 系统 得 以 改善 ， 增 广 
系统 由 每 个 构 型 的 n 个 控制 向 量 场 /，…, f, 张 成 
R” 空间 ， 并 通过 保持 输入 部 分 ,到 沿 着 附加 
的 向 量 场 尽 可 能 接近 零 。 

图 35. 17 给 出 了 用 于 非 完 整 系统 的 轨迹 变形 算法 
的 例子 。 


图 35.17 一 个 拖 着 一 辆 拖车 差分 驱动 移动 机 器 人 ， 
通过 在 线 检测 应 用 轨迹 变形 算法 各 障 


35.11.2 战略 规划 系统 
战略 规划 系统 以 高 频率 ， 重 新 计算 到 目标 位 置 的 


路 径 ， 并 利用 主要 路 径 来 建议 机 器 人 避 障 模块 。 这 些 
移动 系统 的 设计 至 少 涉及 三 个 功能 的 合成 : 模型 构 
造 ， 慎 思 规 划 及 避 障 。 模 型 构造 了 一 个 代表 用 来 进行 
思考 与 记忆 反应 行为 的 基础 。 规 划 器 产生 一 个 全 局 的 
计划 ， 这 一 计划 被 用 于 指导 避 障 模块 来 产生 一 个 局 部 
的 移动 。 下 面 我 们 将 给 出 这 三 个 功能 的 一 个 远景 规划 
并 给 出 三 种 可 能 实现 他 们 的 工具 号 2 。 

l. 模型 生成 器 模块 

一 个 环境 模型 的 建立 (以 增加 规划 的 空间 范围 ， 
并 作为 避 障 的 局 部 内 存 使 用 ) : 一 种 可 能 性 是 使 用 二 
进 制 占据 网 格 ， 每 当 得 到 一 个 新 的 传感器 测量 值 时 则 
更 新 ， 并 在 任何 新 的 测量 值 进入 网 格 之 前 ， 采 用 扫描 
匹配 技术 '*%, 中 来 提高 机 器 人 量 距 。 

2. 规划 模块 

提取 自由 空间 的 连通 性 ( 以 此 来 避免 陷入 往复 
运动 与 局 部 位 置 ) : 一 个 较 好 的 选择 是 像 D* 这 样 的 
动态 导航 功能 。 支 持 规 划 模 块 的 想法 是 集中 在 地 区 的 
局 部 进行 搜索 ， 这 些 地 区 有 环境 已 经 发 生 了 变化 并 影 
响 到 了 计算 机 的 路 径 。 规 划 器 避免 了 陷入 局 部 极 小 ， 
并 实现 了 实时 高 效 的 计算 。 


z 
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3. 避 障 模块 

在 本 章 中 介绍 的 任何 避 碰 移动 的 计算 方法 都 可 以 
被 使 用 。 一 种 可 能 性 是 ND 的 方法 (35.9.6 节 ) ， 因 
为 它 已 经 被 证 明 是 在 小 空间 中 移动 也 是 非常 有 效 的 和 
鲁 棒 的 。 系 统 全 局 的 运行 原理 如 下 ( 见 图 35.18): 
给 机 器 人 一 个 激光 扫描 和 测 程 仪 ， 模 型 建立 器 将 这 些 
信息 输入 到 已 存在 的 模型 中 。 接 下 来 ， 有 关 模 型 中 的 
障碍 和 自由 空间 信息 的 变化 被 规划 模型 用 于 计算 接 下 
来 到 达 目 标的 行程 。 最 后 ， 吕 障 模型 利用 这 些 来 自 战 
略 规划 器 关于 障碍 的 网 格 信息 来 生成 运动 的 路 径 
(驱动 机 器 人 无 障碍 地 到 达 目 标 ) 。 移 动 是 由 机 器 人 
控制 器 执行 的 ， 而 且 在 有 新 的 传感器 测量 值 时 再 重新 
开始 这 一 过 程 。 需 要 特别 强调 的 是 按照 一 致 性 原则 这 
三 个 模块 应 在 一 个 感应 周期 内 保持 同步 。 这 些 系统 的 
优点 是 这 些 模块 的 协作 人 允许 避 开 陷 人 局 部 或 周期 运动 
的 情形 〈 这 个 限制 与 避 障 方法 的 局 部 特点 有 关 ) 。 


感知 
一 激光 扫描 
一 测 距 法 


机 器 人 
图 35. 18 移动 机 器 人 概况 


图 35. 19 给 出 这 一 移动 系统 的 实验 图 片 。 


a) 
图 35. 19 a) 配 有 平面 激光 传感器 的 轮 式 机 器 人 的 
运动 系统 实验 图 片 


图 35. 19 b) 在 给 定时 间 的 运动 系统 信息 : 目前 累积 的 情 
景 图 片 ， 规 划 器 与 移动 方向 的 计算 路 径 以 及 反应 避 障 方法 
的 解 ( 续 ) 


35.12 结论、 未 来 发 展 方向 与 扩展 


阅读 


本 章 介绍 的 算法 工具 表明 ， 运 动 规划 和 避 障 研究 
技术 已 达到 成 熟 水 平 ， 这 些 技术 可 转化 为 真实 的 平台 
来 实现 。 如 今 ， 一 些 室内 移动 机 器 人 也 用 在 日 常生 活 
中 ， 利 用 避 障 技术 在 博物 馆 中 引导 游客 。 室 外 应 用 需 
要 在 观念 与 建 模 方法 上 仍然 需要 一 些 发 展 。 对 于 这 些 
应 用 ， 三 维 传 感 能 力 不 仅 用 来 进行 环境 建 模 而 且 用 来 
检测 障碍 是 必要 的 。 其 中 一 个 例子 就 是 ， 几 个 汽车 制 
造 商 正 在 致力 于 将 其 用 于 平行 停车 辅助 设备 。 本 应 用 
的 难点 是 在 一 个 复杂 的 变化 环境 中 利用 三 维 数据 建立 
一 个 停车 点 的 模型 。 

移动 机 器 人 的 自主 运动 中 存在 很 大 的 挑战 包括 
来 自 于 不 同 机 器 人 研究 领域 中 的 集成 技术 ， 这 些 技 
术 用 来 规划 与 执行 非常 复杂 系统 的 移动 ， 比 如 人 形 
机 器 人 。 在 这 个 意义 上 的 集成 不 仅 指 不 同 的 软件 部 
分 需要 在 一 个 机 器 上 工作 ， 而 且 还 在 一 定 的 科学 意 
义 下 工作 : 经 典 的 带 有 构 型 变量 的 移动 规划 框架 根 
据 全 局 参考 坐标 系 来 定位 机 器 人 ， 而 不 适合 在 不 精 
确 的 地 图 上 部 分 已 知 的 环境 信息 。 像 运动 这 样 的 机 
器 人 任务 需要 根据 环境 标志 具体 指定 。 举 例 来 说 ， 
指出 抓 取 一 个 目标 被 定义 为 移动 的 是 根据 目标 的 位 
置 。 为 这 个 研究 方向 设计 一 个 总 体 框架 的 工作 目前 
还 是 很 少 的 。 

关于 移动 机 器 人 的 规划 和 避 障 相关 的 有 益 读 物 有 
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些 方案 提供 了 更 大 的 灵活 性 但 却 有 更 高 的 存储 需求 。 


环境 模型 的 构造 对 几 个 移动 机 器 人 系统 应 用 的 开 
发 都 有 重要 作用 。 正 是 通过 这 些 环境 模型 ， 机 器 人 才 
可 以 做 出 适宜 当前 环境 状态 的 决定 。 当 机 器 人 探索 环 
境 时 ， 模 型 通过 传感器 的 数据 进行 构建 。 使 用 传感器 
数据 进行 环境 模型 的 构建 有 三 个 难点 。 第 一 ， 模 型 必 
须 简 洁 从 而 使 得 它们 可 以 被 其 他 系统 元 件 ， 如 路 径 规 
划 器 ， 有 效 地 利用 。 第 二 ， 模 型 必须 适应 于 任务 和 环 
境 的 类 型 。 比 如 ， 将 环境 建 模 成 一 系列 平面 就 不 适合 
在 自然 地 形 中 运作 的 机 器 人 。 特 别 是 ， 这 上 暗示 着 对 机 
器 人 来 说 ， 一 个 适合 各 种 环境 的 一 般 性 表示 方法 是 不 
可 能 的 ， 我 们 必须 从 一 系列 不 同 途径 中 选择 一 个 合适 
的 。 第 三 ， 表 示 法 必须 包容 传感器 数据 和 机 器 人 状态 
预测 系统 内 在 的 不 确定 因素 。 而 后 者 尤其 重要 ， 这 是 
因为 在 一 个 共同 坐标 系 中 ， 环 境 模型 通常 随 距 离 的 增 
加 而 累积 传感器 数据 。 机 器 人 位 置 预测 的 偏差 是 难免 
的 ， 而 这 个 因素 必须 在 模型 表示 和 构建 中 考虑 进去 。 


36.1 历史 性 回顾 


从 历史 文献 看 ， 环 境 建 模 的 工作 首先 集中 于 在 室 


内 环境 中 运作 的 机 器 人 。 在 这 种 情况 下 ， 被 建 的 模型 
可 以 得 益 于 环境 可 以 由 参考 地 面 上 的 垂直 结构 表示 的 
事实 。 这 种 简化 得 以 应 用 ， 将 环境 表示 为 二 维 栅 格 。 
测量 和 机 器 人 姿态 预测 中 的 不 确定 性 可 以 使 用 栅 格 占 
据 的 概率 进行 建 模 ， 而 不 是 简单 的 二 进 制 占 据 /空白 
标识 。 室 内 环境 的 另 一 个 特点 是 它们 的 高 度 结构 化 并 
且 主 要 包含 的 是 线性 构造 ， 比 如 线 和 面 。 这 种 观察 导 
致 了 基于 点 、 线 和 面 的 集合 上 ， 可 以 构建 第 二 层 表示 
类 别 以 表现 环境 。 在 这 里 ， 大 量 的 研究 注意 力 专 注 于 
表示 这 些 几何 元 素 相对 姿态 的 不 确定 性 上 ， 其 中 就 包 
括 20 世纪 80 年 代 使 用 卡尔 曼 滤 波 器 和 其 他 概率 性 技 
术 的 大 量 工作 。 

随 着 传 感 技术 ( 比如， 长 距离 的 距离 图 像 激 光 
扫描 仪 和 立体 视觉 ) ， 以 及 移动 机 器 人 系统 的 机 械 
和 控制 方面 上 不 断 的 进展 ， 开 发 使 用 在 非 构造 性 、 
自然 地 形 上 运作 的 移动 机 器 人 系统 就 变 得 可 能 
而 开发 这 种 机 器 人 的 部 分 动机 是 星际 探索 和 军事 应 
用 。 在 这 些 情况 下 ， 将 数据 投射 到 二 维 栅 格 就 不 太 
适宜 了 ， 而 环境 也 不 足以 仅 使 用 少量 的 几 种 几何 元 
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素来 表示 。 因 为 ， 在 多 数 情况 下 ， 假 设 〈 即 便 只 是 
局 部 的 ) 存在 一 个 参考 地 面 是 可 行 的 ， 一 种 自然 的 
表示 法 是 使 用 一 个 2.5 维 栅 格 ， 栅 格 的 每 一 个 单元 
保存 了 该 位 置地 形 的 海拔 信息 (和 其 他 可 能 特征 ) 。 
尽管 已 经 被 广泛 应 用 ， 这 种 海拔 地 图 最 大 的 问题 是 
它们 不 是 一 种 简洁 的 表示 法 而 且 很 难 插入 不 确定 性 
的 表示 。 于 是 ， 很 多 研究 专注 于 为 海拔 地 图 设计 有 
效 的 数据 结构 和 算法 ， 比 如 ， 分 层 制 表示 法 。 最 近 ， 
有 关 不 确定 性 的 难点 被 使 用 海拔 地 图 的 概率 性 表示 
法 解决 了 。 

尽管 海拔 地 图 为 很 多 种 自然 地 形 提供 了 天 然 的 表 
示 方 式 ， 它 们 不 能 用 以 表示 具有 垂直 或 外 悬 结构 的 环 
境 。 这 种 局 限 在 近年 来 变 得 更 明显 ， 因 为 移动 机 絮 人 
在 城市 环境 中 的 应 用 逐渐 增加 (城市 中 很 多 建筑 物 
的 墙 和 其 他 结构 不 能 用 海拔 地 图 表示 ) ， 而 牵涉 到 外 
其 结构 ， 比 如 树 顶 的 空间 数据 的 使 用 也 是 原因 之 一 。 
这 就 导致 了 真正 的 三 维 表 示 法 ， 比 如 点 阵 ， 三 维 栅 格 
和 网 格 的 发 展 。 上 面 提 到 的 两 个 难点 也 出 现在 这 儿 ， 
除了 因为 引入 第 三 维 而 增加 的 复杂 性 外 ， 情 况 变 得 更 
复杂 。 当 前 的 研究 包括 三 维 结构 有 效 的 计算 和 三 维 数 
据 的 概率 性 表示 法 。 

因为 在 所 有 这 些 表示 法 中 涉及 海量 的 数据 ， 
能 否 将 这 些 数 据 分 组 成 与 环境 中 语义 上 有 意义 的 
部 分 所 对 应 的 大 块 就 很 重要 了 。 这 种 分 组 可 以 在 
不 同 层 次 上 进行 ， 取 决 于 应 用 的 环境 。 在 最 低 的 
层次 ， 需 要 做 的 工作 涉及 将 点 分 为 与 导航 任务 
(如 辨别 植被 和 路 面 、 抽 取 墙 面 、 树 的 表面 等 ) dH 
关 的 类 。 在 较 高 层次 的 表示 法 里 面 ， 牵涉 的 工作 
是 抽取 环境 中 可 以 被 看 做 对 导航 任务 有 帮助 特征 
(比如 路 面 ) 的 部 分 。 最 后 ， 表 示 法 层次 最 高 的 部 
分 牵涉 抽取 和 描述 环境 中 的 物体 (比如 ， 自 然 形 
成 的 障碍 物 或 诸如 需要 在 城市 环境 中 运行 时 遇 到 
的 车 等 特别 物体 ) 。 

所 有 这 些 对 环境 的 表示 都 假设 环境 是 静止 的 。 
实 上 ,许多 当下 的 移动 机 器 人 应 用 需要 在 混合 的 环境 
中 运作 。 在 这 些 环境 中 机 器 人 与 其 他 移动 的 物体 共享 
环境 ， 比 如 其 他 机 器 人 、 人 类 和 交通 工具 。 假 设 观 测 
算法 可 以 发 现 并 追踪 环境 中 的 单个 移动 物体 ， 此 时 的 
难点 在 于 将 此 信息 插入 可 以 被 一 个 路 径 规划 咒 使 用 的 
表示 法 。 在 这 种 情况 下 ， 之 前 提 到 的 任何 一 种 表示 法 
可 以 作为 一 个 基础 ， 但 是 它 需 要 延伸 并 添加 一 个 时 间 
维度 以 存储 被 探测 物体 的 位 置 和 状态 的 时 序 信 息 。 这 
种 表示 法 包括 被 探测 物体 的 轨迹 以 及 在 某 些 情况 下 对 
该 物体 未 来 轨迹 的 预测 信息 。 
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36.2 室内 和 结构 化 环境 的 建 模 


36.2.1 占据 栅 格 


占据 栅 格 地 图 ,在 20 世纪 80 年 代 由 Moravec 和 
Elfes 1 发明， 是 一 种 通用 的 、 概 率 性 的 表示 环境 的 
途径 。 这 是 一 种 类 似 于 我 们 计算 一 个 离散 栅 格 里 每 一 
个 单元 的 后 验 概 率 的 技术 ， 而 对 应 于 栅 格 的 是 环境 中 
的 一 片 为 一 个 障碍 物 占据 的 区 域 。 占 据 栅 格 地 图 的 优 
势 在 于 它们 不 需要 依赖 任何 需要 事先 定义 的 特征 。 青 
者 ， 它 们 提供 了 一 种 对 栅 格 单元 定期 的 存 取 和 描述 未 
AU (未 被 观测 ) 的 地 域 的 能 力 ， 而 这 是 很 重要 的 ， 
比如 ， 在 探索 任务 中 。 这 种 方法 的 劣势 在 于 潜在 的 离 
散 化 的 误差 和 很 高 的 内 存 需 求 。 

本 节 我 们 始终 假设 地 图 m. 包含 一 个 二 维 离散 的 
MMe, HAL Soc, WH m, ce, mo EME x, 
机 器 人 获得 的 传感器 输入 是 z.,， 占 据 栅 格 制图 法 计 
算出 一 个 后 验 概 率 p Om |xi.,，z1.,)。 

为 了 保持 计算 较 易 处 理 ， 整 个 方法 假设 栅 格 的 每 
一 个 单元 是 独立 的 ， 即 下 列 公式 成 立 : 


pm zz) = II p(m,l]x,,2,,) (36.1) 
注意 这 是 一 个 严格 的 假设 。 基 本 上 它 说 明 的 是 一 个 单 
元 被 占据 与 否 的 信息 并 不 能 告诉 我 们 任何 有 关 其 相 邻 
单元 的 任何 信息 。 实 际 上 我 们 经 常 发 现 超过 单个 单元 
的 物体 ， 比 如 门 、 橱 和 椅子 等 。 因 而 ， 如 果 我 们 知道 
一 个 单元 被 占据 了 ， 它 的 每 一 个 相 邻 单元 被 占据 的 概 
率 也 应 升 高 。 尽 管 有 此 假设 ， 占 据 栅 格 地 图 成 功 地 应 
用 于 很 多 移动 机 器 人 例子 里 ， 而 在 诸如 定位 和 路 径 规 
划 等 不 同 的 导航 任务 中 ,证 实 为 一 种 强 有 力 的 工具 。 
由 于 式 (36.1) 里 表达 出 的 独立 性 假设 ， 我 们 
可 以 专注 于 对 m 中 的 单个 单元 m, 的 占据 概率 进行 预 
测 。 在 附加 独立 性 假设 的 条 件 下 ， 给 定 pCm, [eris 
za) 和 在 zx, 处 的 新 观测 z,， 我 们 可 以 得 到 下 列 公 式 
以 计算 单元 mj 被 占据 的 概率 p(m, xr, Zu): 


pm, |n, 52 ) = (1+ RCN |x, 2,) . p(m,) 
LIEZ pin, |x, ,2,) (1 -p(m,)) 
I -p(m, CN (36.2) 
p(m, DNE, 


实际 上 ， 我 们 通常 假设 先 验 概率 p(m,) 是 0.5, 
这 样 上 式 乘 积 中 的 第 二 项 变 为 1 从 而 在 公式 中 消去 。 
另外 ， 如 果 我 们 定义 
Odds(x) = 


pix) 
-p(x) 


1 (36.3) 
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累积 的 更 新 可 以 由 式 (36.4) 计算 

Odds( m, |x,.,,2,,) = Odds(m, |x,,z,) * 

Odds( m,) ^! x Odds( m, |x,,,., 25,4) (36.4) 

为 了 从 公式 (36.4) 中 给 出 的 Odds 表示 法 得 到 
占据 概率 ， 我 们 可 以 使 用 公式 (36.5), ， 而 该 式 可 以 
轻易 从 (36.3) 中 推导 而 来 : 


_ Odds(x) 
pCa) ~ 1 + Odds(x) 


剩 下 的 工作 是 如 何 从 给 定 的 单个 观测 z, 以 及 对 应 
的 机 器 人 姿态 % 来 计算 一 个 栅 格 单元 的 占据 概率 
Cm, |x =) 。 该 计算 量 强烈 地 取决 于 机 器 人 的 传 感 
器 而 必须 为 每 一 种 传感器 分 别 进 行 定 义 。 另 外 ， 这 些 
模型 的 参数 必须 适应 于 每 一 个 传感器 的 性 质 。 假 设 方 
T£ dist(x,, m) 代表 在 姿态 x, 处 的 传感器 和 单元 m, 
中 心 之 间 的 距离 。 让 我 们 首先 假设 我 们 只 需 考虑 传 感 
器 锥 体 的 光学 轴 ， 比 如 ， 由 激光 距离 探测 仪 发 射 的 激 
HR, EBA, p(m,|x,, z7) 可 以 表示 为 
z 是 最 大 的 距离 读数 
Pu， mi 不 被 z, 照 到 
Doo) Z, —dist(x,,m,) | <r/2 


(36.5) 


P prior s 
(36.6) 


pin, |, iB) = 


P tree , Z, >dist(x, 3 m,) 


式 中 , > 是 棚 格 地 图 的 分 辨 率 。 显 然 , 有 0 大 ms < 
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如 果 使 用 声呐 传感器 ， 传 感 器 模型 稍微 复杂 一 
些 ， 因 为 这 种 传感器 不 是 光束 型 的 ， 而 且 观 测 噪 声 
要 比 激光 传感器 的 大 。 实 际 上 ， 我 们 通常 使 用 三 种 
方程 的 混合 来 表示 该 模型 。 首 先 ， 观 测 的 影响 ( 表 
示 为 pm 和 pe， 以 及 Pr 和 pa 的 区 别 ) 随 距 离 的 
增 大 而 减 小 。 再 者 ， 声 呐 的 近似 观测 信息 受 噪声 影 
响 很 大 。 因 而 ,我 们 通常 使 用 一 个 逐个 线性 方程 来 
对 从 ps. 到 p, 的 平滑 渐变 建 模 。 最 后 ， 声 呐 传 感 带 
不 能 使 用 光束 传感器 的 模型 ， 因 为 它 发 射出 的 是 锥 
形 的 信号 。 观 测 的 准确 性 随 被 观测 单元 与 观测 光学 
轴 的 距离 变 大 而 降低 。 准 确 性 的 表达 由 先 验 概 率 的 
推导 而 来 ， 并 通常 使 用 具有 零 均 值 的 高 斯 模型 。 因 
此 ， 最 大 的 准确 性 是 沿 光 学 轴 ， 而 距 光 学 轴 越 远 降 
[Tr M 

图 36.1 显示 了 一 个 生成 模型 的 两 个 例子 ， 画 出 
了 测量 值 是 2m ( 见 图 36.1a) 和 2.5m ( 见 图 36. 1b) 
时 导致 的 占据 概率 的 三 维 绘图 。 在 此 图 中 ， 传 感 器 锥 
形 的 光学 轴 与 坐标 系 的 * 轴 重 合 ， 而 传感器 位 于 坐标 
系 原 点 。 如 图 所 示 ， 对 于 距离 x BOT z 的 单元 ， 占 
据 概 率 高 。 单 元 的 占据 概率 随 着 距离 减 小 (REF z) 
和 角度 距离 的 变 大 而 减 小 。 


一 个 单个 超声 波 测量 导致 的 占据 概率 


a) zz2m b) z=2. 5m 


图 36. 2 显示 了 一 个 iRobot 公司 出 产 的 B21r 机 器 
人 使 用 一 系列 观测 进行 制图 的 过 程 。 第 一 行 显示 出 如 
果 使 用 一 系列 事先 的 超声 波 扫描 进行 地 图 构建 。 之 后 
机 器 人 进行 了 一 系列 18 次 超声 波 扫描 ， 每 一 扫描 包 
括 24 个 测量 。 第 2 ~7 行 显示 出 这 18 次 扫描 造成 的 
占据 概率 。 该 图 的 最 后 一 行 显示 的 是 将 所 有 的 单个 观 
测 整合 置信 地 图 得 到 的 占据 地 图 栅 格 。 可 以 看 出 ， 概 
率 收敛 于 一 个 扫描 发 生 的 走廊 结构 环境 的 图 案 。 


图 36.3 则 画 出 一 个 典型 的 室内 环境 的 合成 地 图 。 
36.2.2 ”直线 地 图 


使 用 直线 模型 对 环境 进行 表示 的 方法 是 对 上 述 基 
于 栅 格 的 近似 法 的 一 种 常用 蔡 代 手 段 。 比 起 那些 不 使 
用 参数 的 表示 法 ， 直 线 模型 具有 几 点 优势 。 它 们 比 栅 
格 法 需要 的 内 存 少 得 多 ， 因 而 更 适应 不 同 的 环境 尺 
寸 。 因 为 不 会 引入 离散 误差 ,它们 也 更 加 精确 。 本 
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节 ， 我 们 考虑 使 用 一 系列 来 自 一 条 直线 的 点 来 计算 直 
线 方程 的 问题 。 如 果 点 的 数据 使 用 ”对 笛 卡 儿 坐标 系 
Gu, v). 给 出 ,那么 使 到 所 有 点 的 距离 的 平方 和 最 
小 的 直线 方程 可 以 由 下 列 封闭 形 给 出 

-2Y G-x)Gr-x) 
Y G-» - G-2)] 


r 2 xcos + ysin$ 


tan2$ = (36.7) 


(36.8) 


十 


十 


十 


十 


TA 
c 
b 

Ne 
A 

* 
B 
D 

' z= 


E 


| 
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图 36.2 一 个 走廊 环境 的 渐进 地 图 绘制 。 (左上 角 的 

画面 是 初始 地 图 ， 而 最 下 方 的 画面 则 是 最 后 形成 的 地 

图 。 介 于 两 者 之 间 的 是 由 机 器 人 接收 到 的 单个 超声 波 
扫描 构建 的 局 域 地 图 927) 


图 36.3 ”由 超声 波 扫描 构建 的 占据 栅 格 地 图 rm ?1 


RP, a= Enys E y 在 这 些 方程 


中 , > 是 从 原点 到 该 直线 的 法 线 距 离 而 o EAR 
角度 。 

不 幸 的 是 ， 当 数据 点 是 由 多 条 直线 构造 形成 的 时 
候 ， 封 闭 形 的 解 不 存在 。 这 种 情况 下 会 出 现 两 个 问 
题 。 第 一 ， 我 们 必须 知道 有 几 条 直线 存在 ， 而 第 二 是 
我 们 必须 解决 数据 结合 的 问题 ， 即 找到 属于 每 一 条 直 
线 的 数据 点 。 一 旦 直线 数目 和 数据 结合 的 问题 得 到 解 
Be, 我 们 就 可 以 使 用 式 (36.7) MIÈ (36.8) Xit 
算 每 一 个 直线 的 参数 。 

解决 对 多 线 状 构造 的 距离 扫描 的 建 模 问题 ， 我 们 有 
一 个 流行 的 方案 。 这 个 方案 ,， 最早 追溯 到 Douglas 和 
Peucker WI EAE?! ， 也 被 称 为 分 拆 合并 算法 。 关 键 概念 
是 递归 性 地 将 数据 点 集 分 为 能 更 准确 地 近似 为 一 条 直线 
模型 的 子 集 。 该 方案 开始 于 从 所 有 的 点 计算 出 一 条 直 
线 ， 然 后 决定 距离 该 直线 最 远 的 点 。 如 果 该 距离 小 于 一 
个 给 定 的 阔 值 ， 算 法 停止 并 给 出 找到 的 直线 作为 输出 结 
果 。 和 否则 ， 继 续 计 算出 距离 到 由 点 集 开 始 和 结束 的 两 点 
形成 的 直线 的 点 。 该 点 因而 被 称 为 分 拆 点 。 它 把 点 集 分 
拆 成 两 个 部 分 ， 一 部 分 包括 从 分 拆 点 到 点 集 开 始 的 点 而 
另 一 部 分 包括 从 分 拆 点 到 点 集结 束 的 点 。 算 法 递归 地 应 
用 到 分 拆 后 的 两 个 子 集 里 直到 结束 。 分 拆 合并 算法 应 用 
于 一 个 数据 点 集 的 情形 如 图 36. 4 所 示 。 


图 36.4 分 拆 合 并 算法 应 用 于 一 个 数据 点 集 的 情形 


尽管 分 拆 合 并 算法 很 有 用 也 很 有 效 ， 但 是 它 不 能 
保证 最 后 的 结果 是 优化 的 ， 也 就 是 说 ， 最 后 得 到 的 模 
型 使 所 有 点 的 平方 距离 最 小 化 。 一 种 可 以 找到 这 种 优 
化 模型 的 方案 是 基于 期 望 最 大 化 (EM) 算法 的 。 而 
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在 这 里 描述 的 应 用 里 ，EM 算法 可 以 当做 模糊 均值 


聚 类 算法 的 一 个 变 体 。 o aps 0 EF m 
直线 已 经 求解 。 进 一 步 假设 给 定 包含 直线 集 
10,, 7,0,1 的 模型 9 的 条 件 下 ， 一 个 数据 点 z= (x, 


y) 的 可 能 性 定义 为 


p(z|@) = 


l se] (36.9) 
Co 


1 
ast 2 
RP, o 是 测量 噪声 的 标准 差 ，0, 是 距离 点 z 
里 得 距离 4(z，9,) 最 小 的 直线 。 

EM 算法 的 目标 是 产生 具有 不 断 增 大 可 能 性 的 迭 
代 次 序 模型 。 为 了 达到 此 目标 ， 我 们 引入 一 个 称 为 对 
应 性 的 变量 c; e 10，1| ， 它 指明 了 每 一 个 点 属于 革 
一 个 模型 的 直线 成 员 。 因 为 每 一 个 对 应 性 变量 的 正确 
数值 是 未 知 的， 我 们 必须 预测 它们 的 后 验 概率 。 假 设 
b 是 模型 的 一 个 直线 成 员 ， 而 = 是 一 次 测量 。 那 么 e， 
的 期 待 值 ， 也 即 测量 ;属于 直线 /的 概率 在 三 步 又 中 
的 计算 为 


的 欧 几 


Cj ci [8,,2;] =p(c; l0, .z; ) (36. 10) 
=ap(z; |c;,0,)p(c; (8) 

(36. 11) 

(36. 12) 

ZH 


=a'p(z; |0;) 
TEMER, HAIE E 步骤 中 计算 得 来 的 共 
虑 在 内 ， 计 算 模型 的 参数 . 


0 = arg mi 之 LAI Le, | 6,2; ]d (2,01) 


(36. 13) 
对 所 有 属于 z 的 数据 点 给 定 固定 的 方差 r， 我 们 可 以 
根据 下 列 公 式 计算 出 封闭 形 的 具有 最 大 可 能 性 的 模 
型 。 而 这 些 公式 则 是 ， 考 虑 了 在 给 定 下 步骤 计算 出 
的 期 望 值 条 件 下 得 到 的 数据 结合 的 不 确定 因素 ， 式 
(36.7) 和 式 (36.8) 的 概率 性 变形 


p= 


T— -2Y, Ele, 6.21€ - x) (Y - y) 
í a 
(36. 14) 
r, 2 xcoso, + ysinó, (36.15) 
这 里 元 和 了 的 计算 是 ， | 
E Y Fle, Ozil 25 E[c;| 6,2, 
"XS Mul ^ Ys 
(36.16) 
图 36. 5 画 出 了 使 用 基于 EM 的 方法 从 311823 个 


数据 点 抽取 的 直线 地 图 。 在 此 例 中 ， 模 型 包含 94 条 
线 。 决 定 最 优 直线 的 一 条 途径 是 使 用 贝 叶 斯 信息 
Jiu] 9641 。 


EUG lot? 
LÀ i 


图 36.5 基于 了 EM 算法 U^, J 311823 个 距离 点 
产生 的 包含 94 条 线 的 直线 地 图 


36. 2.3 拓扑 地 图 


上 述 的 表示 方法 主要 关注 环境 的 几何 构造 ， 与 其 
形成 对 比 的 是 ， 拓 扑 表示 法 同样 受到 相当 的 关注 。 有 
关 拓 扑 地 图 的 一 个 开创 性 方案 是 1988 年 Kuipers 和 
Byun 的 成 果 '* 中 。 在 此 方案 中 ,环境 由 一 个 类 似 于 
lH 线 图 的 结构 表示 ， 而 其 中 节点 是 环境 中 显著 的 地 
方 。 连 接 节点 的 是 机 器 人 可 以 在 不 同 地 方 之 间 移 动 的 
行进 边缘 。 这 里 ， 特 别 的 地 方 是 由 距 其 附近 的 物体 距 
离 辨 认 的 。 特 别 的 地 方 由 Chose 和 他 的 同事 们 定义 为 
一 般 性 Voronoi 图 中 的 集合 点 ”7 E 即 具有 三 次 或 更 
多 次 的 点 。 一 个 一 般 性 的 Voronoi 图 是 由 中 离 最 近 的 
两 个 或 更 多 个 障碍 物 边 际 等 距 的 点 组 成 的 集合 。 因 为 
可 以 考虑 使 用 一 般 性 的 Voronoi 图 作为 与 环境 的 拓扑 
性 架构 具有 高 度 相 似 性 的 蓝图 ， 这 种 图 成 为 一 种 很 常 
用 的 环境 表示 法 。 它 们 广泛 地 应 用 于 路 径 规划 。 为 了 
规划 出 环境 中 从 一 个 开始 UR 一 个 目标 点 的 路 径 ， 机 
器 人 只 需要 先 规划 出 一 条 路 径 到 Voronoi 图 中 ， 然 后 
沿 着 Voronoi 图 规划 到 达 ER. IgE TRUST. 图 36.6 
显示 出 一 个 在 室内 环境 使 用 一 般 性 Voronoi 图 的 例子 。 
注意 在 此 图 中 ， 只 显示 了 那些 可 以 由 机 器 人 穿 过 而 不 
会 与 任何 物体 相 撞 的 图 形 部 分 。 


图 36.6 一 个 使 用 一 般 性 Voronoi Æ 795? 的 例子 
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36.2.4 基于 地 标的 地 图 


在 具有 鲜明 特征 的 环境 中 ， 基 于 地 标的 地 图 使 用 
广泛 。 如 果 我 们 假设 机 器 人 的 位 置 总 是 已 知 的 ， 那 么 
剩 下 的 任务 只 是 维持 一 个 关于 各 个 地 标的 位 置 随时 间 
的 预测 。 在 平面 环境 中 , mo 由 天 个 均值 为 心 、 协 方 
差 为 下 ;的 二 维 高 斯 函数 组 成 ， 每 一 个 高 斯 函数 代表 
一 个 地 标 。 如 果 此 观测 问题 的 线性 化 模型 已 知 ， 那 么 
可 以 使 用 延伸 卡尔 曼 滤 波 器 (EKF) 的 公式 对 这 些 高 
斯 函数 进行 更 新 。 需 要 注意 的 是 ,与 使 用 EKF 的 基 
于 地 标的 同时 定位 与 地 图 绘制 (SLAM) 问题 相 比 ， 


1 


a) 


图 36.7 a) 一 个 移动 机 器 人 对 一 系列 岩石 进行 地 图 绘制 。 


o c 
0 

© 
Q 


那里 我 们 需要 一 个 2K+3 维 的 状态 向 量 (机 器 人 的 
位 置 为 3 维 而 各 个 地 标的 位 置 共 需 要 2K 维 ) ， 而 这 
里 我 们 只 需要 KK 个 二 维 高 斯 函数 来 表示 整个 地 图 ， 
因为 机 器 人 的 位 置 已 知 。 比 如 ， 这 个 属性 已 经 应 用 于 
FastSLAM 41 rp Pe 51. 

图 36. 7 中 的 左 图 显示 的 是 一 个 装 有 一 颗 SICK 
牌 的 激光 测 距 仪 的 机 器 人 对 环境 中 岩石 的 位 置 进行 
绘制 地 图 。 而 右 图 描述 的 是 机 器 人 的 路 径 ， 以 及 由 
手工 绘制 的 地 标 位 置 ,与 自动 预测 的 地 标 位 置 的 
对 比 。 


© 


b) 


b ) 画 出 了 机 器 人 的 路 径 和 


预测 的 地 标 (岩石 ) 位 置 。 而 圆圈 代表 的 是 人 工 手 绘 的 岩石 位 置 


36.3 自然 环境 和 地 形 建 模 


从 一 个 重点 放 在 室内 环境 的 概率 性 技术 对 环境 建 
模 的 调查 :2 中 ， 我 们 可 以 沿 几 个 方向 建立 一 个 分 
类 : 米 制 的 对 比 拓扑 的 对 比 语义 的 ， 以 机 器 人 为 中 心 
的 对 比 以 环境 为 中 心 的 ， 或 是 基于 应 用 的 。 我 们 选择 
首先 回顾 纯 几 何 模型 (海拔 栅 格 、 三 维 栅 格 和 网 
格 ) ， 然 后 回顾 具有 低级 属性 〈 比 如 代价 地 图 ) 的 几 
何 模型 ， 然 后 是 具有 丰富 语义 属性 的 模型 ， 最 后 回顾 
异 构 结 构 和 分 层 制 模型 。 
海拔 栅 格 

假设 地 形 可 以 由 方程 h=f(x,y) dn, Hx 
M y 是 一 个 参考 地 点 的 坐标 ， 而 A 则 是 对 应 的 海拔 信 
息 。 一 个 很 自然 的 表示 法 是 一 个 包含 在 离散 位 置 
(x;，Y;) 数值 的 数字 海拔 地 图 ( 见 图 36.8)。 因 为 
海拔 地 图 使 用 简单 的 数据 结构 ， 而 且 可 以 用 一 种 相对 
直接 的 方式 从 传感器 数据 产生 ， 它 广泛 地 应 用 于 在 自 


36. 3.1 


然 环 境 中 操作 的 移动 机 器 人 。 我 们 指 的 这 种 自然 环境 
是 不 包括 具有 垂直 面 和 悬挂 结构 的 〈 比 如 ， 星 际 探 
BRP EPA 01) 。 对 移动 机 器 人 使 用 海拔 地 图 需要 
解决 几 个 问题 。 


~ 
> 


图 36.8 使 用 来 自 一 个 距离 传感器 的 累积 三 维 数据 
进行 海拔 地 图 建制 的 例子 


当 传感器 数据 大 致 均匀 分 布 在 参考 面 上 时 ， 一 
个 均匀 采样 的 栅 格 模型 是 适用 的 。 比 如 ， 使 用 航空 
数据 就 是 这 种 情况 。 但 是 ， 对 于 地 面 机 器 人 来 说 ， 
因为 传感器 与 参考 面 形成 的 人 射 角 较 小 ， 数 据 在 参 
考 面 上 的 分 布 变化 剧烈 。 这 个 问题 可 以 通过 使 用 变 
化 的 单元 尺寸 ， 而 不 是 均匀 采样 的 单元 尺寸 进行 解 
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决 。 在 这 种 情况 下 ， 栅 格 单元 在 参考 面 上 的 分 布 可 
以 看 做 近似 安装 在 该 参考 面 上 的 传感器 测量 出 来 的 
点 的 分 布 。 对 于 地 图 是 相对 于 机 器 人 的 当前 位 
°°") ( 见 图 36.9) 的 情况 ,这 种 不 均匀 的 表示 
法 具有 重要 作用 。 如 果 地 图 是 位 于 全 局 参考 系 的 话 ， 
需要 进行 频繁 的 采样 。 


图 36.9 一 个 具有 变化 尺寸 的 以 机 器 人 


为 中 心 的 地 图 实例 OO 


与 用 以 构造 参考 栅 格 的 采样 方案 无 关 ， 栅 格 中 
的 数据 密度 因为 地 形 表面 的 局 部 自我 阻挡 而 变化 ， 
而 且 会 导致 投射 的 传感器 数据 的 分 辨 率 与 栅 格 的 分 
辩 率 不 一 致 。 这 种 不 一 致 会 造成 麻烦 ， 因 为 从 规划 
器 的 角度 来 看 ， 海 拔 地 图 看 上 去 会 像 散 布 的 具有 海 
拨 数 据 的 单元 ， 而 有 些 单元 没有 数据 。 预 测 空白 单 
元 海拔 的 基本 要 点 是 对 具有 已 知 海拔 数据 的 单元 进 
行 插值 。 实 现 这 种 做 法 必须 多 加 小 心 ， 以 避免 将 环 
境 中 被 地 形 (距离 阴影 ) 遮挡 的 部 分 填充 了 数值 ， 
因为 这 些 部 分 海拔 数据 是 无 从 得 知 的 。 这 种 错误 可 
能 会 是 灾难 性 的 ， 因 为 路 径 规划 器 也 许 会 规划 出 经 
过 完全 未 知 区 域 的 路 径 。 和 常用 的 解决 途径 是 使 用 表 
面 插值 技术 以 包含 一 个 条 款 ， 用 以 允许 出 现 插值 结 
果 面 的 不 连续 状况 ”| 。 其 他 方案 包括 使 用 传感器 
的 几何 关系 造成 的 视觉 限制 ， 从 而 预测 每 一 个 单元 
的 可 能 海拔 数值 >” 。 
插值 技术 的 一 个 难点 是 明确 地 考虑 传感器 的 不 确 
定性 。 特 别 是 ， 在 一 个 固定 分 辨 率 栅 格 中 ， 把 传感器 
变化 的 分 辩 率 当做 一 个 距离 的 函数 是 很 困难 的 。 一 个 
替代 方法 是 使 用 具有 不 同 分 辨 率 的 多 重 栅 格 。 在 一 个 
特定 点 (x, y) 处 的 合适 的 分 辨 率 ， 取 决 于 从 (x, 
y) 到 最 近 处 的 传感器 的 位 置 ， 从 而 可 以 在 该 分 辩 率 
下 ， 取 得 (x, y) 处 来 自 合适 地 图 的 数值 。 通 常 ， 
距离 越 远 ， 使 用 的 地 图 越 稀 昔 。 这 一 途径 使 用 了 基于 


传感器 几何 关系 的 优化 分 辨 率 '*"”， 从 而 去 除了 因 
为 传感器 在 远 距离 处 的 欠 采 样 ， 而 造成 的 地 图 上 的 
缺口 。 

传感器 测量 的 不 确定 性 在 传感器 的 坐标 系 中 表 
达 得 最 自然 ， 比 如 ， 沿 着 测量 的 方向 表示 误差 。 其 
结果 是 ， 将 这 种 误差 模型 转换 为 海拔 地 图 变 得 非常 
困难 ， 因 为 治 测量 方向 的 分 布 对 应 于 一 个 特定 点 的 
参考 平面 的 分 布 ， 而 不 是 海拔 数值 的 分 布 。 当 根据 
传感器 的 输入 更 新 一 个 单元 的 数值 时 ， 我 们 必须 考 
虑 测量 误差 因为 倾斜 角 中 的 误差 造成 的 随 距离 变 大 
的 现象 。 预 测 (x, y) 处 的 高 度 有 的 常用 办 法 是 使 
用 一 个 卡尔 曼 滤 波 器 。 如 果 我 们 假设 rc 是 (x, y) 
处 沿 牌 直方 向 的 当前 测量 有 的 标准 差 ， 而 o,_ ,是 
h WERE, 我 们 可 以 使 用 下 列 公 式 绪 得 具有 标 
准 差 o, 的 新 的 预测 A, 


2 
oh, +o jh 


ca 


h, = 一 一 - (36.17) 
Ga tg 
2 gau 
oa (36. 18) 
o tgo 


1-1 


应 对 变化 的 不 确定 性 因素 的 一 个 可 能 解决 方案 是 采用 


一 个 模型 ， 使 得 高 度 测 量 的 标准 差 随 着 距离 测量 长 度 
的 增加 而 线性 增 大 ， 如 图 36. 10 所 示 。 


Æ 36.10 高度 测量 的 标准 差 可 以 建 模 
为 线性 的 取决 于 栅 格 单元 的 距离 


植被 覆盖 是 恢复 地 形 海 拔 的 另 一 个 误差 源 ， 
因为 它们 全 部 或 部 分 地 遮挡 了 机 器 人 的 传感器 
“视线 。 基 于 对 过 去 相似 地 形 表面 的 观察 和 机 器 
人 在 地 形 上 的 状态 以 预测 机 器 人 前 面 的 地 表 海 拔 ， 
在 线 学 习 技 术 可 以 解决 植被 覆盖 造成 遮挡 的 
[RJ gp O6 17) 。 

介 于 二 维 海拔 地 图 和 完全 的 三 维 表示 法 之 间 
的 表示 方法 ， 包 括 延 展 海拔 地 图 :22 和 所 谓 的 多 
重水 平 表面 地 图 :1 。 这 些 方案 在 具有 垂直 物体 
或 悬挂 体 (如 桥梁 ) 的 构造 地 形 中 特别 有 用 i 
图 36.11) 。 
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b) 


= 


c) 


图 36. 11 不 同 版 本 的 数字 海拔 地 图 [aa 11 


a) 一 个 桥梁 的 扫描 CAR) 


b) 从 此 数据 点 集 计 算出 的 标准 差 地 图 


c) 一 个 正确 表示 了 桥 下 通道 的 


延展 海拔 地 图 d) 一 个 正确 表示 了 垂直 物体 高 度 的 多 水 平 表面 地 图 


36.3.2 三 维 栅 格 和 点 阵 
如 上 所 述 的 海拔 地 图 假设 了 一 个 参考 方向 。 在 很 
多 情况 下 ， 这 种 假设 是 不 成 立 的 。 一 种 替代 方案 是 将 


数据 直接 用 三 维 表 示 而 不 是 投射 到 一 个 参考 的 二 维 平 
面 。 这 样 做 的 优势 在 于 所 有 的 传感器 数据 可 以 保留 原 
始 属性 而 对 环境 的 几何 关系 没有 任何 限制 。 问 题 则 在 
于 必须 有 足够 的 运算 力 以 有 效 地 处 理 非常 大 的 三 维 点 
阵 。 基 于 动态 三 维 栅 格 的 数据 结构 可 以 用 于 此 目 
的 *。 这 类 表示 法 的 一 个 有 趣 特征 是 它们 可 以 获得 从 
真正 的 局 部 三 维 数据 分 布 评估 来 的 计算 量 ( 见 
图 36. 12) ， 而 不 是 从 一 个 局 部 表面 来 的 计算 量 。 这 一 点 
很 重要 ， 比 如 ， 有 植被 分 布 的 环境 不 能 建 模 为 一 个 面 。 

过 去 ， 基 于 八 又 树 的 三 维 表示 法 已 经 成 功 地 使 用 
安装 在 一 个 水 下 机 器 人 的 激光 声呐 传感器 来 对 一 个 水 
下 洞穴 进行 绘图 后 2 。 从 内 存 和 存 取 时 间 来 说 ， 数 
据 结构 的 设计 保证 有 效 维持 数 以 百 计 的 地 图 ， 以 保存 
用 以 定位 的 粒子 。 但 是 ， 密 集 的 三 维 占据 栅 格 也 被 用 
以 对 自然 环境 建 模 ， 使 用 的 传感器 是 雷达 21 。 每 
一 种 方案 的 例子 都 呈现 于 图 36. 13 。 

在 上 述 的 方案 中 ， 数 据点 阵 ， 有 些 时候 以 概率 性 
的 方式 累积 形成 环境 重建 模型 。 一 个 使 用 离散 的 传 感 


Key 


5 
L 


图 36. 12 
= 植被 ， 红 色 = 表面 ， 


三 维 数据 和 分 类 结果 (绿色 


— 


a 


器 采样 进行 环境 重建 的 方法 是 将 数据 概率 性 融合 成 米 
制 地 图 “2 。 这 种 方法 与 占据 栅 格 在 几 个 方面 存在 
不 同 : 存储 要 求 和 分 辩 率 是 渐变 的 而 不 是 固定 的 ， 可 
延展 的 可 能 性 也 更 大 。 


36.3.3 网 格 


如 上 所 述 ， 海 拔 地 图 简便 而 易于 实现 ， 但 是 它们 
只 适用 于 特定 类 型 的 地 形 ; 其 他 的 极端 情况 是 ， 直 接 
使 用 三 维 表示 法 更 具 一 般 性 但 计算 量 也 更 大 ， 而 且 也 
不 能 明确 地 表示 表面 的 连续 性 。 折 中 的 方案 是 使 用 网 
格 表 示 地 图 。 这 种 方案 的 吸引 力 在 于 ， 理 论 上 ， 它 可 
以 表示 任何 混合 的 表面 。 同 时 它 也 是 一 种 简洁 的 表示 
方法 。 尽 管 网 格 的 初始 尺寸 可 能 很 大 ， 我 们 可 以 在 参 
考 文献 中 发 现 有 效 的 网 格 简化 算法 :的 2 ， 可 以 将 表 
示 地 图 的 顶点 数目 缩小 。 

网 格 的 关键 问题 是 ， 在 复杂 环境 中 ， 从 原始 数据 
抽取 增强 的 表面 可 能 会 很 困难 。 特 别 是 ， 数 据 被 传 感 
器 噪声 和 来 自 其 他 不 能 表示 为 连续 表面 的 来 源 (如 
植被 ) 的 随机 零散 物 所 污染 。 另 外 ， 有 必要 对 数据 


中 不 连续 的 地 方 准确 检查 ， tt 
会 在 网 格 信息 处 理 过 程 中 被 意外 地 连接 :55 。 
36. 14 显示 的 是 一 个 城市 环境 的 网 格 表 示 。 


三 维 数据 点 集 分 类 和 绘图 的 例子 
蓝 色 = 线条 


; 颜色 的 饱和 度 与 分 类 结果 的 可 信和 度 成 正比 ) 


b) 累积 了 大 量 扫 描 的 地 图 
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图 36. 13 一 个 自然 环境 的 容积 地 图 的 示例 
a) 一 个 水 下 洞穴 的 地 图 b) 描绘 了 来 自 一 个 雷达 的 地 形 地 图 


D) 


图 36. 14 一 个 使 用 网 格 表示 的 地 图 的 两 个 不 同 观测 面 b ) 和 c) 。 网 格 的 获得 是 通过 
对 环境 a) 的 扫描 〈 网 格 只 使 用 了 原始 数据 采样 的 十 分 之 一 ) 


在 _ 些 应 用 中 ， 目 标 不 是 生成 支持 自动 驾驶 的 地 案 以 根据 准确 的 机 器 人 模型 计算 通过 代价 ， 比 如 ，_- 
形 模型 ， 而 是 生成 人 类 可 以 察看 的 模型 。 城 市 规划 就 。 种 方案 通过 考虑 局 域 斜 坡 和 地 形 的 三 维 纹理 来 计 
是 这 样 一 种 典型 应 用 。 范 例 包 括 使 用 照相 机 视频 图 像 。” 算 cz 。 更 多 的 模型 用 到 机 器 人 详细 的 动力 学 模型 。 
产生 城市 环境 的 三 维 结构 模型 ， 而 照相 机 安装 在 装配 ”在 这 种 情况 下 ， 针 对 机 器 人 的 不 同 速 度 和 地 图 上 不 同 
有 惯性 导航 系统 的 移动 车 辆 上 fs2g ， 以 推 扫 式 使 用 的 路 径 弯曲 度 ， 计 算出 不 同 的 通过 代价 。 代 价 棚 格 被 
两 个 激光 扫描 仪 ， 一 个 用 于 绘图 而 另 一 个 用 于 定 。 用 于 一 个 最 小 代价 规划 器 。 因 为 当 机 器 人 穿越 环境 
位 ce2l ， 并 使 用 一 个 与 绘图 激光 器 配 准 的 照相 机 ; 时， 地 形 地 图 在 不 断 更 新 中 ， 有 必要 在 新 的 数据 到 来 
采集 高 分 状 率 的 激光 数据 和 图 像 以 为 建筑 物 生成 几何 。 时， 对 通过 代价 也 时 时 更 新 。 然 后 ， 很 重要 的 一 点 是 
和 光度 都 正确 的 三 维 模型 ns2a 。 图 36. 15 ETX 规划 器 可 以 使 用 变动 的 代价 ， 从 而 不 需要 在 新 的 数据 
此 呈现 了 城市 地 形 的 具有 纹理 的 网 格 范例 。 到 来 时 重新 处 理 整 个 枯 格 。 
, RA des AMARRA UHR — A 
36.3.4 代价 地 图 子 是 D* 系统 ， 它 使 用 4* 的 一 个 版 本 并 完全 支持 动态 
海拔 地 图 最 直接 的 用 处 是 计算 机 格 中 每 一 个 单元 。 栅 格 更 新 ss-s0 。 当 任何 时 候 ， 一 个 棚 格 单元 (或 
的 通过 代价 。 代 价 的 计算 是 通过 比较 当地 的 地 形 形 状 ”一 组 帆 格 单元 进行 了 更 新 ， 规 划 器 对 其 内 部 表示 
和 机 器 人 的 动力 学 模型 。 研 究 者 们 已 经 推出 了 几 种 方 ”进行 最 小 化 更 新 从 而 使 得 优化 的 路 径 可 以 迅速 更 新 。 
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图 36. 15 使 用 纹理 化 网 格 表示 的 城市 地 形 模型 范例 


a) 来 


对 代价 与 存储 于 栅 格 中 的 海拔 数据 之 间 的 关系 进 
行 准 确定 义 可 能 会 很 难 。 实 际 上 ， 除 了 大 的 海拔 梯度 
或 大 坡度 等 极限 情况 之 外 ， 我 们 没有 多 少 依据 来 决定 
为 什么 地 形 的 某 一 部 分 比 另 一 部 分 更 容易 通过 ， 因 为 
这 种 依据 很 大 程度 上 取决 于 机 器 人 的 准确 配置 。 正 因 
为 如 此 ， 最 近 的 研究 工作 集中 在 直接 从 观察 中 推导 出 
代价 地 图 ， 而 不 是 使 用 手工 的 算法 。 一 个 方案 牵涉 到 
学 习 融 合 一 系列 事先 确定 的 代价 的 最 佳 权 数 。 男 一 个 
方案 使 用 从 其 他 来 源 计 算出 的 代价 来 推断 如 何 决定 机 
器 人 当前 看 到 的 地 形 的 代价 ; 比如， 空中 的 视觉 信息 
可 用 以 预测 被 一 个 地 面 机 器 人 使 用 的 地 形 的 通行 代 
价 …” 或 者 通过 分 析 机 器 人 实际 穿 过 地 形 的 路 径 以 
学 习 将 局 域 海拔 信息 分 配 成 代价 数据 。 类 似 的 在 线 学 
习 算 法 用 以 预测 地 形 崎 邮 度 ”3 ST Ya A PRE 
或 者 总 体 通 过 性 ”以 用 在 代价 地 图 中 。 
图 36. 16 是 在 线 代价 学 习 的 例子 。 


语义 属性 


上 述 的 表示 法 考虑 的 仅仅 是 如 何 简 洁 地 存储 数据 
并 能 用 于 预测 机 器 人 的 地 形 可 通过 性 的 代价 。 有 时 候 
必须 考虑 有 关 环 境 的 更 高 层次 的 认 知 ， 比 如 ， 机 器 人 


— 


36. 3.5 


参考 文献 [36.24], b) 来 自 参考 文献 [36. 26], c) 来 


参考 文献 [36. 25] 


图 36. 16 在 线 代价 学 习 的 例子 ”1 。 
红色 表示 。 


机 器 人 的 路 径 用 
注意 在 机 器 人 行进 过 程 中 代价 的 变化 。 颜色 
越 暗 ， 代 价 越 小 


周遭 物体 的 位 置 和 种 类 或 者 环境 中 地 形 的 类 型 ( 植 
被 、 泥 沼 、 墙 面 ) 。 为 方便 起 见 ， 我 们 选择 的 这 种 信 
息 是 附加 在 环境 中 不 同 部 位 的 语义 属性 。 有 几 种 不 同 
的 途径 来 产生 、 表 示 语 义 属性 。 一 种 可 能 的 途径 是 从 
环境 中 抽取 地 标 。 与 室内 环境 相应 的 ， 室 外 环境 也 可 
以 使 用 地 标 进行 建 模 。 地 标的 定义 广泛 ， 可 以 是 景象 
中 容易 探测 的 元 素 ， 在 环境 中 特别 显眼 而 且 容 易 辩 
认 。 它 们 可 以 是 特别 的 物体 ， 比 如 岩石 “” 、 和 森林 
rig FOS sy d dc YR BE rp 069899 或 自然 环境 
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中 W* 外 表 在 二 维 或 三 维 表示 法 里 有 特征 的 位 置 。 
地 标 可 以 用 以 构建 环境 的 拓扑 表示 或 者 与 米 制 方法 联 
合 使 用 。 最 近 的 研究 成 果 就 包括 了 在 不 预先 指定 什么 
物体 是 地 标的 条 件 下 学 习 环 境 的 一 种 简练 表示 
TROON) ， 和 使 用 统计 学 习 技术 ”| 从 图 像 中 提取 
新 的 特征 。 还 有 一 些 研 究 中 ,使 用 非 线性 降 维 技术 以 
获得 环境 的 表示 ， 其 结果 在 地 面 和 空中 机 器 人 上 得 到 
了 展现 。 

语义 问题 也 被 看 做 分 类 组 合 问题 。 确 实 ， 前 几 节 
里 描述 的 地 图 表示 法 是 较 低 水 平 的 ， 因 为 它们 没有 试 
图 将 数据 点 组 合 进 更 大 的 结构 。 这 些 结构 从 几何 关 
系 、 地 形 类 型 或 语义 内 容 来 说 更 具有 一 致 性 。 实 际 
上 ， 我 们 也 许 会 想 要 将 数据 归纳 为 更 大 的 单元 ， 从 而 
可 以 用 于 规划 占 或 者 传输 给 男 一 个 机 器 人 或 操作 员 ，; 
比如 ， 在 城市 环境 中 ， 我 们 想 要 将 对 应 于 墙 面 属于 平 
面 的 部 分 数据 组 合 。 图 36. 17 显示 了 这 样 一 个 例子 。 


-20 : 
—30 -20 -10 


图 36. 17 一 个 样本 图 像 ， 其 中 随机 采样 的 高 维 图 像 块 
媒 入 到 低 维 表示 里 面 0907 


一 种 方案 是 将 三 维 点 分 组 为 基于 较 低 水 平分 类 和 
特征 探测 的 元 素 “*1。 研 究 人 员 对 这 些 元 素 的 形状 
做 进一步 分 析 以 区 分 成 不 同 的 自然 物体 元 素 (树干 、 
树枝 ) 和 人 工 障碍 物 (电线 )。 他 们 将 几何 元 素 匹 配 
到 这 些 物 体 上 (地 面 匹 配 成 网 格 、 植 被 匹配 成 树 形 
球 、 树 村 匹配 成 圆柱 ) ， 从 而 制造 出 有 关 地 形 的 更 高 
级 别 的 、 简 练 的 几何 描述 。 

局 域 地 形 分 类 可 以 通过 从 地 图 中 计算 出 局 域 特征 
并 将 地 图 中 的 每 一 个 元 素 分 类 成 地 形 的 不 同类 来 完 


成 。 这 可 以 利用 海拔 地 图 完成 。 在 这 种 情况 下 ， 元 素 
是 海拔 地 图 的 单元 格 ， 或 者 利用 点 阵 表示 法 完成 ， 而 
在 后 者 里 面 ， 元 素 则 是 三 维 位 置 。 给 定 地 图 中 的 一 个 
fii x, Mow 的 局 部 区 域 V(x) 中 计算 出 一 个 特征 向 
EV), MAIR RASV) 则 返回 在 * 处 的 地 形 
类 型 。 过 去 用 到 的 特征 是 围绕 每 一 个 元 素 的 地 图 数据 
的 随机 分 布 ， 比 如 斜坡 和 海拔 分 布 ““ ， 以 及 三 维 
点 在 其 邻 域 中 分 布 的 二 阶 矩 ""“ 。 地 形 的 分 类 取决 
于 应 用 。 最 直接 的 分 类 方案 使 用 一 个 二 进 制 分 类 器 将 
地 形 分 为 障碍 物 区 域 和 可 通过 区 域 。 更 深层 次 的 分 类 
顺 将 地 图 区 分 为 更 多 的 类 ， 像 植被 、 固 定 表 面 和 线性 
结构 P677. 其 中 的 一 个 例子 如 图 36. 12 所 示 。 在 
某 些 情况 下 ， 有 可 能 对 地 图 中 每 一 个 数据 元 素 *， 将 
对 此 元 素 进 行 测量 的 方向 进行 存储 。 这 种 情况 下 ， 有 
可 能 利用 对 测量 光束 d(x) 与 地 图 其 他 部 分 的 交界 的 
分 析 ， 进 行 分 类 的 细 化 。 例 如 ， 这 种 类 型 的 几何 分 
r^t E AME F PR SS BAL BBE PAIR I TT POT 
以 及 抽取 负 值 的 障碍 物 “” (比如 沟 槽 ) 。 在 所 有 这 
些 情况 下 ， 分 类 信息 不 能 直接 由 局 域 统计 获取 ， 而 必 
须 从 长 距离 几何 推导 中 得 来 。 

这 类 针对 局 域 特征 分 类 的 方案 与 从 图 像 中 抽取 特 
征 的 方案 相似 ， 也 受到 相似 性 的 限制 。 特 别 是 ， 这 些 
表示 法 对 用 以 计算 特征 的 邻 域 的 选择 很 敏感 。 如 果 邻 
域 太 大 ,来 自 一 大 片区 域 的 信息 被 平均 ， 导 致 比较 差 
的 分 类 性 能 。 如 果 太 小 ， 在 邻 域内 没有 足够 的 信息 来 
提供 可 靠 的 分 类 。 这 种 情况 可 能 更 加 恶化 ， 因 为 地 图 
的 分 辨 率 或 更 准确 地 讲 ， 地 图 中 的 数据 点 的 密度 ， 可 
能 随 与 传 感 避 的 距离 而 剧烈 变化 。 这 个 问题 的 解决 可 
以 通过 使 用 地 图 不 同位 置 的 不 同 邻 域 尺 寸 或 者 依赖 于 
地 图 位 置 来 调节 分 类 器 ， 通 常 基于 距离 传感器 的 远 
UEC) 。 第 二 个 问题 是 生成 分 类 器 函数 广 这 个 问 
题 的 解决 可 以 通过 使 用 一 个 物理 模型 来 预测 地 图 中 局 
域 数据 分 布 的 统计 量 ， 根 据 的 假设 是 不 同 的 地 形 类 
ALS 99) 。 通 常 这 种 方案 比较 困难 ， 而 比较 易于 接受 
的 方案 是 使 用 训练 数据 来 训练 分 类 器 。 

这 种 水 平 的 分 类 提供 了 有 关 地 形 的 局 域 类 型 的 信 
息 ， 可 以 用 以 规划 ， 但 它 没 有 提取 可 能 存在 于 环境 中 
的 延伸 的 几何 结构 (ILE 36.18) 。 几 何 结构 诸如 平 
面 小 块 可 以 使 用 类 似 于 在 室内 环境 的 背景 中 介绍 的 方 
法 (如 EM) 进行 提取 。 但 是 增加 的 难度 在 于 室外 环 
境 存在 大 量 的 散落 物 ， 从 而 使 这 些 平面 小 块 的 抽取 变 
得 复杂 。 通 常人 们 使 用 可 以 处 理 这 种 级 别 的 散落 物 的 
和 鲁 棒 技术 进行 抽取 |。 

基于 局 域 属性 的 分 类 可 以 通过 考虑 背景 信息 得 以 
大 幅度 的 改进 。 比 如 ， 隐 藏 马 尔 可 夫 (Markov) 模型 
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图 36. 18 地形 分 类 以 及 几何 特征 的 提取 (三维 数据 
在 左边 显示 ， 而 特征 地 图 与 提取 的 
平面 和 植被 在 右边 显示 000) 


就 成 功 地 用 于 激光 数据 的 分 析 以 决定 地 形 的 可 通过 
性 。 另 一 类 基于 马尔 可 夫 随 机 域 的 结构 学 习 方 
案 与 边缘 最 大 化 原则 的 结合 ， 具 有 广泛 的 应 用 ， 包 括 
三 维 地 形 分 类 和 物体 分 段 ”” ， 或 构建 结构 抽取 


图 36.19 a) 针对 地 形 分 类 的 结构 学 习 '* 


36.4 动态 环境 


大 多 数 的 地 图 绘制 技术 是 为 静态 环境 开发 的 。 有 
些 方案 如 占据 栅 格 或 海拔 地 图 本 质 上 可 以 应 付 物体 在 
其 中 移动 的 动态 环境 。 占 据 栅 格 的 缺点 在 于 当 一 个 机 
格 单元 空 了 的 时 候 需 要 时 间 去 忘记 该 机 格 之 前 的 状 
态 。 而 海拔 地 图 的 缺点 在 于 一 个 地 点 海拔 的 改变 需要 
机 器 人 接收 到 与 该 地 点 被 占据 时 同样 多 的 信息 。 为 了 
解决 这 些 问 题 ， 几 种 替代 方案 已 经 被 握 了 出 来 。 一 个 
非常 流行 的 技术 是 使 用 基于 特征 的 追踪 算法 来 追踪 移 


( 见 图 36. 19) 。 最 后 ， 还 有 一 些 方法 针对 机 器 人 的 定 
位 和 环境 建 图 ， 用 于 自动 探测 、 选 择 、 建 模 和 辨认 自 
SR Hp DO 
36.3.6 RMAWNDE UR 

为 了 进行 长 距离 导航 ， 一 辆 自动 驾驶 交通 工具 必 
须 执 行 一 系列 任务 ， 包 括 绝对 和 相对 定位 、 路 径 规 划 
和 反应 式 障碍 物 规避 。 另 外 ， 它 还 必须 执行 一 些 工作 
以 完成 要 求 的 任务 ， 比 如 探测 物体 并 建 模 等。 为 了 达 
到 这 个 目标 ， 研 究 人 员 开发 了 分 层 制 框架 以 应 付 需要 
的 表示 法 的 不 同比 例 和 间隔 尺寸 %*%1。 更 进一步 ， 
从 异 构 结 构 的 图 像 源 (空中 、 和 斜坡 和 地 面 上 ) 构建 
的 模型 以 应 用 于 生成 支持 火星 探索 的 三 维 多 分 辨 率 地 
形 模型 5 5 iB Ace qa b FL O91 ， 使 用 米 制 地 图 来 
增强 特征 地 图 ， 提 供 了 一 个 密集 但 简洁 的 环境 表示 
法 。 另 一 种 表示 法 基于 激光 /图 像 表 征 和 一 个 米 制 地 
图 来 提取 地 标 5591 。 


D) 


b) 构建 特征 抽取 0597 


zm pev 9 。 当 被 追踪 的 动态 物体 的 类 型 已 知 
的 时 候 ， 这 种 算法 特别 有 效 。 这 种 技术 已 经 成 功 地 应 
用 于 从 距离 数据 学 习 三 维 城市 地 图 的 情况 里 。 如 图 
36.20 和 图 36. 21 所 示 ， 是 从 城市 情景 中 的 移动 机 器 
人 获得 的 三 维 数据 中 ， 移 除 动 态 物 体 的 应 用 。 这 种 追 
踪 计 算 的 替代 方案 包括 在 不 同时 间 比 例 上 学 习 地 
FAC | REA] Bh AS BE AY AB TAIRA OO) ， 或 只 
XY AS DET Hill HA, 
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图 36. 20 a) 一 个 移动 机 器 人 正在 获取 一 幅 城 市 景象 的 三 维 扫描 图 
b) 景象 中 的 人 造成 了 结果 网 格 中 的 错误 数据 点 


c) 同一 幅 景 象 ， 人 被 滤 除 的 效果 


图 36. 21 


结论 与 扩展 阅读 


有 关 典 型 表示 法 以 及 如 何 应 用 这 些 表 示 法 于 移动 


Bla A 


nt 


航 的 深入 阅读 ， 可 以 参见 最 近 有 关 移 动机 天 


人 的 图 书 %” ,中 。 针 对 空间 数据 结构 的 基础 知识 及 


它们 的 应 用 的 


项 全 面 调查 可 以 在 Samet 的 著作 中 


Hee) 
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本 章 全 面 介绍 了 同时 定位 与 建 图 (simultane- 
ous localization and mapping) 问题 ， 其 缩写 SLAM 
更 为 人 所 知 。SLAM 解决 机 器 人 在 未 知 环境 中 的 导 
航 问 题 。 在 未 知 环境 中 导航 时 ， 机 器 人 设法 获取 所 
在 环境 的 地 图 ， 同 时 用 所 建 的 地 图 进行 自身 定位 。 
SLAM 的 运用 受到 两 方面 的 推动 : 有 的 对 详细 的 环 
境 模 型 感 兴 趣 ， 有 的 要 求 对 移动 机 絮 人 的 位 置 保持 
精确 的 感知 。SLAM 可 以 满足 这 两 种 要 求 。 

我 们 回顾 了 三 种 主要 方法 ， 近 年 来 出 现 的 大 量 
方法 均 可 由 这 几 种 方法 导出 。 第 一 种 是 用 扩展 卡尔 
ED (extended Kalman filter, EKF) zs Blas 
人 的 最 佳 估 计 的 传统 方法 。 第 二 种 方法 从 以 下 事实 
获得 直觉 : SLAM 问题 可 看 做 约束 的 稀 玻 图 ， 它 用 
非 线性 优化 恢复 地 图 和 机 器 人 的 位 置 。 最 后 ， 简 述 
了 用 非 参 数 密度 估计 和 有 效 的 分 解 方法 解决 SLAM 
问题 的 粒子 滤波 方法 。 本 章 讨论 了 这 些 基本 方法 的 
扩展 ， 阐 明了 各 种 SLAM 问题 ， 提 出 了 对 该 领域 的 


37.1 概述 


本 章 全 面 介绍 了 实现 移动 机 器 人 导航 的 关键 技 
术 之 一 : 同时 定位 与 建 图 (SLAM)。SLAM 解决 如 
何 获取 移动 机 器 人 所 在 环境 的 空间 地 图 ， 并 同时 确 


BE, 广泛 引用 了 相关 研究 ,讨论 了 待 研 究 的 


问题 。 
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多 领域 都 研究 了 从 一 个 移动 传感器 平台 对 环境 进行 
建 模 的 问题 , 尤其 是 在 摄影 测绘 (photogramme- 
uy) 0^7 fn 3T PEEL C 9 BOT. SLAM 就 是 建立 
在 这 些 工 作 的 基础 上 ， 并 常常 将 基本 方法 扩展 为 更 
灵活 的 算法 。 

本 章 首先 给 出 SLAM 问题 的 基本 定义 ,包括 对 不 


定 机 器 人 相对 此 地 图 模型 的 位 姿 问 题 。SLAM 通常 
看 做 实现 真正 自主 的 移动 机 器 人 的 最 重要 的 问题 之 
一 。 尽 管 在 该 领域 已 取得 重大 进展 ， 它 还 是 面临 巨 
大 挑战 。 目 前 , 已 经 有 了 对 静态 、 结 构 化 的 、 有 限 
大 小 的 环境 建 图 的 鲁 棒 方法 。 对 非 结构 化 的 、 动 态 
的 或 大 规模 环境 的 建 图 在 很 大 程度 上 还 是 有 待 研究 
的 问题 。 

SLAM 的 历史 起 源 可 追溯 到 高 斯 *”" ， 为 计算 
行星 轨道 而 发 明 的 最 小 二 乘法 (least-squares meth- 
od) 主要 归功 于 他 。 在 20 世纪 ， 机 器 人 学 以 外 的 许 


同 版 本 SLAM 问题 的 简单 分 类 。 本 章 的 重点 是 对 本 领 
域 的 三 种 基本 方法 及 其 各 种 扩展 作 科普 性 介绍 。 正 如 
读者 很 快 将 认识 到 的 ，SLAM 问题 没有 单一 的 最 佳 
解 。 使 用 者 所 采用 的 方法 将 取决 于 多 种 因素 ， 如 理想 
的 地 图 分 辨 率 、 更 新 时 间 和 地 图 特征 的 性 质 等 。 然 
而 ， 本 章 讨 论 的 三 种 方法 覆盖 了 本 领域 中 的 主要 算 
法 。 为 深入 研究 SLAM 算法 ， 我 们 向 读者 推荐 近年 出 
版 的 一 本 关于 概率 机 器 人 学 的 教科 书 ， 它 用 多 个 章节 
介绍 了 SLAM 问题 :5 。 也 可 参考 最 近 出 版 的 关于 
SLAM 的 一 个 深入 教程 "1。 


a 
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37.2 SLAM: 问题 定义 


37.2.1 数学 基础 


SLAM 问题 定义 如 下 。 移 动机 器 人 在 未 知 环境 中 
从 某 个 坐标 已 知 的 位 置 开始 运动 ， 运 动 的 不 确定 性 使 
机 器 人 全 局 坐标 的 确定 变 得 越 来 越 困 难 。 机 器 人 在 运 
动 时 能 感知 所 在 环境 。SLAM 问题 就 是 在 构建 环境 地 
图 的 同时 确定 机 器 人 相对 于 该 地 图 的 位 置 。 

在 形式 上 ，SLAM 最 好 用 概率 术语 描述 。 用 1 表 
示 时 间 ， 用 %, 表示 机 器 人 的 位 姿 。 对 于 在 平地 上 移 
动 的 机 器 人 ，x, 通常 是 一 个 三 维 向 量 ， 由 两 维 平面 位 
置 坐标 和 一 个 表示 它 的 朝向 的 旋转 角 组 成 。 这 样 位 姿 
序列 或 轨迹 (path) 可 表示 为 

X, = 4,3, 35 57 Xp] (37.1) 

式 中 , 7 为 某 一 终止 时 刻 〈 了 可 以 是 ) 。 初 始 位 姿 
xy 已 知 ， 其 他 位 姿 不 能 直接 感知 。 
里 程 计 提 供 了 两 个 连续 位 置 之 间 的 相对 信息 。 
u, RIR t -1 时 刻 到 1; 时刻 之 间 的 运动 里 程 。 这 些 妆 
可 以 从 机 器 人 轮子 的 编码 器 或 其 电动 机 的 控制 
得 ， 序 列 


[E 
4} E 


Up = | uy ,u us ur] (37.2) 
描述 了 机 器 人 的 相对 运动 。 对 于 无 噪声 运动 , HU, 
足以 恢复 从 初始 位 姿 x 开始 的 过 去 的 x. 然而， 里 
程 测量 是 有 噪声 的 ， 因 此 轨迹 积分 不 可 避免 地 会 偏离 
真实 轨迹 。 

最 后 ， 机 器 人 可 以 感知 环境 中 的 物体 。 用 m 表 
示 真 实 的 环境 地 图 。 环 境 可 由 地 标 、 物 体 和 表 
R, m 描述 了 它们 的 位 姿 。 通常 假设 环境 地 图 
变 (HRA) mu. 

机 器 人 测量 建立 了 m 中 的 特征 与 机 器 人 位 姿 
x, 之 间 的 关系 。 如 果 我 们 不 失 一 般 性 ， 假 设 机 顺 
人 在 每 个 时 间 点 恰好 测量 一 次 ， 则 测量 序列 可 表 
示 为 


im g 
m gm 
E 


Lop = 2; 2,52) 552p] (37.3) 

图 37.1 说 明了 SLAM 问题 中 涉及 的 变量 ， 给 出 
了 位 姿 和 传感器 测量 序列 ， 以 及 这 些 变量 之 间 的 因果 
关系 。 这 种 图 被 称 为 图 模型 (graphical model), ČA 
助 于 理解 SLAM 问题 中 的 依赖 关系 。 

SLAM 问题 就 是 根据 里 程 计 和 测量 数据 恢复 环境 
模型 和 机 器 人 位 姿 序列 Xpo CERP K SLAM 问题 
分 为 同样 有 实际 意义 的 两 种 主要 形式 ， 一 种 被 称 为 完 
全 SLAM (full SLAM) 问题 : 估计 完整 的 机 器 人 轨迹 
和 地 图 的 后 验 概率 


图 37.1 SLAM 问题 的 图 模型 。 弧 表 示 因 果 关 
系 ， 阴 影 节 点 是 机 器 人 可 直接 观测 的 。 在 SLAM 
中 ， 机 器 人 设法 恢复 未 观测 到 的 变量 


p(X, m |Z,,U,) (37.4) 
上 式 意味 着 ， 完 全 SLAM 根据 现 有 的 数据 计算 X, 和 
m 的 联合 后 验 概率 。 注 意 “ | ” 右 侧 的 变量 都 是 机 
器 人 可 直接 观测 的 ， 左 侧 的 则 是 要 估计 的 。 我 们 将 看 
到 ， 离 线 SLAM 算法 通常 是 批 处 理 的 ， 即 同时 处 理 所 
有 数据 。 
第 二 种 同样 重要 的 SLAM 问题 是 在 线 SLAM 
(Online SLAM) ， 定 义 为 

p(x,,m|Z,,U,) (37.5) 
在 线 SLAM 旨 在 恢复 机 器 人 的 当前 位 姿 ， 而 不 是 整 条 
轨迹 。 在 线 算 法 通常 是 增 量 式 的 ， 在 每 一 时 刻 处 理 一 
个 数据 项 。 文 献 中 这 类 算法 常 被 称 为 滤波 器 。 

不 论 解 决 上 述 哪 一 种 问题 ， 机 器 人 都 还 需要 两 个 
模型 : 描述 里 程 测量 u, 与 机 器 人 位 姿 x,_| A x, 间 关 
系 的 数学 模型 ， 以 及 描述 测量 值 x 与 环境 m 和 机 器 
人 位 姿 x, 间 关 系 的 模型 。 这 些 模 型 对 应 图 37. 1 中 
的 弧 。 

TE SLAM 中 ， 常 常 将 这 些 数学 模型 看 做 概率 分 
布 : p(x, lx ,, u,) 表示 机 器 人 从 已 知 位 姿 x ,出 发 
且 测 得 的 里 程 数据 为 w 时 位 姿 x, 的 概率 分 布 ， 同 样 
p(z |x,, m) 表示 在 已 知 环境 m 中 的 已 知 位 姿 x, 处 
测 得 z, 的 概率 分 布 。 当 然 ， 在 SLAM 问题 中 我 们 不 知 
道 机 器 人 的 实际 位 姿 ， 也 不 知道 真实 的 环境 。 我 们 将 
看 到 ， 贝 叶 斯 准则 (Bayes rule) 可 解决 此 问题 ， 它 
将 这 些 数学 关系 转换 为 可 根据 测量 数据 恢复 这 些 隐 含 
变量 的 概率 分 布 的 形式 。 

37.2.2 示例: 地 标 环境 中 的 SLAM 

SLAM 的 一 种 常用 设置 是 假设 环境 中 有 许多 地 标 

点 。 当 创建 二 维 (2—D) 地 图 时 ， 地 标点 可 能 对 应 


门框 和 房间 的 拐角 ， 可 用 投影 到 二 维 地 图 上 的 点 坐标 
描述 。 在 二 维 环境 中 ， 每 个 地 标点 用 两 个 坐标 值 描 
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述 。 因 此 若 环境 中 有 ON 个 地 标点 ， 则 整个 环境 地 图 
就 是 一 个 2N 维 向 量 。 

在 通常 的 研究 设置 中 ， 机 器 人 可 以 检测 三 个 量 : 
与 附近 地 标 间 的 相对 距离 、 相 对 方位 、 这 些 地 标的 特 
征 。 距 离 和 方位 均 伴 有 噪声 ， 但 在 最 简单 的 情况 下 ， 
检测 到 的 地 标的 特征 是 完全 已 知 的 。 

为 对 这 种 设置 进行 建 模 ， 先 定义 准确 的 无 噪声 
的 测量 函数 ， 测 量 函 数 疡 描述 了 传感器 的 工作 方式 : 
它 以 环境 描述 m UBL di A MZ x, 作为 输入 计算 测 
量 值 


h(x,,m) (37.6) 
在 上 述 简化 的 地 标 设置 中 ， 可 直接 计算 A, RES 
单 的 三 角 计 算 。 
概率 测量 模型 可 由 此 测量 函数 加 上 噪声 项 得 到 ， 
它 是 峰值 在 h(x,，m) 处 、 人 允许 存在 测量 噪声 的 概率 
m 


p(z, x, m) - N(h(x,,m)Q,) (37.7) 
这 里 入 表示 以 h(x,，m) 为 中 心 的 二 维 正 态 分 布 ， 
2x2 和 矩阵 Q, 是 随时 间 变 化 的 噪声 协 方差 矩阵 。 
运动 模型 可 由 机 器 人 的 运动 学 模型 得 到 。 给 定位 
姿 向 量 x ,和 运动 ww， 可 根据 经 典 运 动 学 计算 x,， 将 
这 一 函数 表示 为 g 


g(x, ,,u,) (37.8) 

则 运动 模型 定义 为 以 g (x. uw) 为 中 心服 从 高 斯 
噪声 的 正 态 分 布 

p(x, |x,_1,u,) ~N(g(%,_,,u,),R,) (37.9) 

这 里 R, 是 协 方差 矩阵 ， 由 于 位 姿 是 三 维 向 量 ， 因 此 
R, 是 3 x 3 和 矩阵。 

有 了 这 些 定义 ,我 们 就 具备 了 阐述 SLAM 算法 的 

条 件 。 文 献 中 ， 具 有 距离 一 方位 检测 的 地 标点 问题 目 

前 已 得 到 了 最 广泛 的 研究 ,但 SLAM 算法 并 不 局 限于 

地 标 环境 。 然 而 ， 不 管 地 图 如 何 表示 ， 传 感 器 特性 如 

何 ， 任何 SLAM 算法 都 需要 对 m 中 的 特征 、 测 量 模 


手 。 基 于 特征 的 SLAM 从 传感器 数据 流 中 提取 稀 
玻 的 特征 ， 地 图 仅 由 特征 组 成 。 本 文 的 地 标点 实 
例 就 是 一 个 基于 特征 的 SLAM 问题 。 基 于 特征 的 
SLAM 方法 往往 更 有 效率 ， 但 由 于 特征 提取 丢弃 了 
传感器 测量 中 的 其 他 信息 ， 其 结果 可 能 不 如 体积 
SLAM, 

2. 拓扑 的 与 度量 的 

一 些 建 图 方法 只 恢复 环境 的 定性 描述 来 表示 基本 
位 置 间 的 关系 ， 这 种 方法 被 称 为 拓扑 法 。 拓 扑 图 可 以 
定义 在 一 个 独特 位 置 集合 和 这 些 位 置 间 的 定性 关系 
(如 位 置 A 与 位 置 B 相 邻 ) 集合 上 。 度 量 SLAM 方法 
则 提供 了 这 些 位 置 间 的 度量 信息 。 近 些 年 ， 拓 扑 方法 
已 经 过 时 ， 尽 管 有 充分 证 据 表 明 ， 人 经 常 使 用 拓扑 信 
息 进 行 导航 。 

3. 已 知 与 未 知 一 致 性 

一 致 性 问题 是 将 检测 到 的 物体 的 特征 与 其 他 检测 
到 的 物体 相关 联 的 问题 。 在 上 述 地 标示 例 中 ， 我 们 假 
设 地 标的 特征 已 知 。 一 些 SLAM 算法 做 这 样 的 假设 ， 
另 一 些 算 法 则 不 然 。 不 做 这 些 假设 的 算法 提供 特殊 机 
制 来 估计 测 得 的 特征 与 已 观测 到 的 地 图 地 标 之 间 的 一 
致 性 。 一 致 性 估计 问题 就 是 众所周知 的 数据 关联 问题 
(data association problem) ， 它 是 SLAM 中 最 难 解决 的 
问题 之 一 。 

4. 静态 的 与 动态 的 

静态 SLAM 算法 假设 环境 不 随时 间 变 化 ， 动 态 方 
法 则 允许 环境 中 存在 变化 。 绝 大 多 数 SLAM 文献 都 假 
设 环境 是 静态 的 ， 动 态 影 响 通 常 只 被 看 做 测量 异常 。 
关于 动态 环境 变化 的 推理 方法 更 复杂 ， 但 这 些 方法 在 
多 数 应 用 中 往往 鲁 棒 性 更 好 。 

5. 小 不 确定 性 与 大 不 确定 性 

SLAM 问题 可 根据 它们 处 理 的 位 姿 不 确定 性 的 程 
度 进行 分 类 。 最 简单 的 SLAM 算法 只 允许 位 姿 估计 有 
小 误差 ， 这 类 方法 适用 于 机 器 人 沿 着 一 条 没有 交叉 的 


型 p(z, lies m) 和 运动 模型 p (x, lx, s u,) 有 同样 
清晰 的 定义 。 


37.2.3 SLAM 问题 分 类 


SLAM 问题 可 按 多 种 不 同 的 方式 分 类 。 大 多 数 重 
要 的 研究 论文 根据 基本 假设 来 确定 问题 的 类 别 。 上 文 
已 出 现 过 这 样 的 一 种 分 类 : 完全 SLAM 与 在 线 
SLAM。 其 他 常用 的 分 类 如 下 。 

1. 基于 体积 的 与 基于 特征 的 

体积 SLAM (volumetric SLAM) 对 地 图 进行 高 
分 辨 率 采样 以 获得 有 真实 感 的 环境 重 构 ， 它 的 地 
图 m 通常 具有 很 高 的 维 数 ， 这 使 计算 可 能 非常 惠 


路 移动 ， 然 后 沿 同一 条 路 返回 的 情况 。 但 在 许多 环境 
中 能 从 多 个 方向 到 达 同 一 位 置 ， 因 此 机 器 人 可 能 积累 
很 大 的 不 确定 性 ， 这 就 是 所 谓 的 闭环 问题 ( loop- 
closing problem) 。 在 闭合 一 个 环 路 时 ， 不 确定 性 可 能 
很 大 。 闭 环 能 力 是 当前 SLAM 算法 的 一 个 关键 特性 。 
如 果 机 器 人 能 检测 到 自身 在 某 个 绝对 坐标 系 中 的 位 置 
信息 ， 如 通过 使 用 全 球 卫星 定位 系统 (GPS) 接收 
机 ， 不 确定 性 可 降低 。 

6. 主动 的 与 被 动 的 

在 被 动 SLAM 算法 中 ， 某 个 另外 的 实体 控制 着 机 
器 人 ，SLAM 算法 只 进行 观测 。 绝 大 多 数 SLAM 算法 
都 是 这 样 ， 它 们 为 机 絮 人 设计 者 提供 了 实现 任意 运动 
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控制 器 、 追 求 任意 运动 目标 的 自由 。 在 主动 SLAM 
中 ， 机 器 人 主动 探索 环境 以 获得 更 准确 的 地 图 。 主 动 
SLAM 算法 通常 可 以 在 较 少 的 时 间 内 得 到 更 精确 的 地 
图 ， 但 约束 了 机 器 人 的 运动 。 也 存在 一 些 混 合 方法 ， 
其 中 SLAM 算法 只 控制 机 器 人 传感器 的 朝向 ， 但 不 控 
制 运动 方向 。 

7. 单机 器 人 与 多 机 器 人 SLAM 

尽管 近来 多 机 器 人 探索 问题 受到 关注 ， 但 多 数 
SLAM 问题 都 是 为 单机 器 人 平台 定义 的 。 多 机 器 人 
SLAM 问题 有 多 种 形式 。 在 有 些 问题 中 ， 机 器 人 能 够 
互相 观测 到 ， 而 在 另 一 些 问题 中 机 器 人 被 告知 相对 初 
始 位 姿 的 信息 。 多 机 器 人 SLAM 问题 也 可 以 根据 机 器 
人 之 间 人 允许 的 通信 类 型 进行 分 类 。 在 有 些 问 题 中 ， 机 
器 人 间 的 通信 无 延迟 、 具 有 无 限 带 宽 。 更 现实 的 情况 
是 只 有 邻近 的 机 器 人 可 互相 通信 ， 而 且 通 信 受 到 延迟 
和 带宽 有 界 的 限制 。 

上 述 分 类 表明 ， 存 在 一 系列 的 SLAM 算法 。 目 前 
许多 会 议 都 为 SLAM 设立 了 多 个 讨论 专题 。 本 章 关 
注 非常 基本 的 SLAM DT, RPGR A PL A 
的 静态 环境 。 本 章 结尾 对 扩展 方法 进行 了 论述 ， 也 给 
出 了 相关 文献 。 


37.3 三 种 主要 的 SLAM 方法 

本 节 回 顾 三 种 基本 的 SLAM 方法 ， 多 数 其 他 算法 
都 可 由 它们 导出 。 第 一 种 是 扩展 卡尔 曼 滤波 器 
(EKF) SLAM， 它 是 历史 上 最 早 的 SLAM 算法 ， 由 于 
其 计算 性 能 的 限制 ， 近 年 来 变 得 有 点 非 主 流 。 第 二 种 
基于 图 表示 ， 成 功 地 用 稀 玻 非 线性 优化 方法 解决 
SLAM 问题 ， 已 成 为 解决 完全 SLAM 问题 的 主要 方 
法 。 第 三 种 也 是 最 后 一 种 方法 使 用 被 称 为 粒子 滤波 器 
的 非 参 数 统计 滤波 技术 ， 是 在 线 SLAM 的 一 种 主流 方 
法 ， 并 对 SLAM 中 的 数据 关联 问题 提供 了 轨 新 的 解决 
方案 。 


37.3.1 扩展 卡尔 曼 滤 波 器 


从 历史 上 看 ，SLAM 的 EKF 方法 是 最 早 的 ， 或许 
也 是 最 有 影响 的 。 参 考 文献 [37.8-10] 和 参考 文献 
[37.11, 12] 介绍 了 EKF SLAM, 首先 提出 用 单个 状 
态 向 量 估计 机 器 人 位 姿 和 一 组 环境 特征 ， 用 关联 误差 
协 方差 矩阵 表示 这 些 估 计 的 不 确定 性 ， 其 包含 了 机 器 
人 和 特征 状态 估计 之 间 的 相关 性 。 当 机 器 人 在 环境 中 
运动 并 进行 测量 时 ， 系 统 的 状态 向 量 和 协 方差 矩阵 用 
扩展 卡尔 曼 滤 波 器 进行 更 新 S 。 观 测 到 新 特征 
时 ， 新 的 状态 被 添加 到 系统 状态 向 量 中 ， 系 统 协 方差 
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该 方法 假设 采用 度量 的 基于 特征 的 环境 表示 ， 其 
中 物体 可 以 在 适当 的 参数 空间 有 效 地 用 点 表示 。 机 器 
人 的 位 姿 和 特征 的 位 置 形成 一 个 不 确定 空间 关系 网 
络 。 恰 当 的 表示 方法 是 SLAM 中 的 关键 问题 ， 这 一 问 
题 与 本 手册 第 36 章 和 第 3 篇 中 检测 和 环境 建 模 主 题 
密切 相关 。 

EKF 算法 用 多 变量 高 斯 分 布 表示 机 器 人 估计 

p(x,,m|Z,,U,) -N(u,£X,) (37.10) 
高 维 向 量 j 包含 机 器 人 自身 位 姿 和 环境 特征 位 置 的 
最 佳 估计 。 在 本 章 的 地 标点 示例 中 ， 由 于 需要 用 三 个 
变量 表示 机 器 人 的 位 姿 ，2N 个 变量 表示 地 图 中 的 N 
^b, EIIE u, 的 维 数 是 3 +2N。 

ARE Y. 是 评价 以 jw 为 期 望 估计 时 的 误差 的 协 
方差 矩阵 ， 是 大 小 为 (3 +2N) x (3 +2N) 的 二 次 
和 矩阵。 在 SLAM 中 ， 这 一 矩阵 通常 是 明显 的 非 稀 
下 矩 阵 。 非 对 角 元 描述 了 不 同 变量 估计 的 相关 性 。 
由 于 机 器 人 的 位 姿 不 确定 ， 导 致 地 图 中 地 标的 位 
置 也 不 确定 ， 因 此 存在 非 零 相 关 。 维 护 这 些 非 对 
角 元 素 的 重要 性 是 EKF SLAM 的 主要 特性 
Pa 

对 本 章 的 点 地 标 例子 来 说 ，EKF SLAM 算法 很 容 
易 得 出 。 假 设 某 时 刻 运动 函数 g 和 观测 函数 /都 是 线 
性 的 ， 则 在 任何 一 本 关于 卡尔 曼 滤 波 的 教科 书 中 所 撒 
述 的 普通 卡尔 曼 滤波 器 都 可 以 使 用 。EKF SLAM 用 泰 
勒 级 数 展开 将 函数 g 和 /线性 化 一 一 这 也 是 标准 的 教 
科 书 内 容 。 因 此 ，EKF SLAM 只 是 将 普通 EKF 以 最 基 
本 的 形式 (不 考虑 任何 数据 关联 问题 用 于 在 线 
SLAM 问题 而 已 。 

图 37.2 说 明了 用 于 一 个 人 工 环 境 示 例 的 EKF 
SLAM 算法 。 将 机 器 人 移动 的 起 始 位 置 作为 其 坐标 系 
的 原点 。 机 器 人 在 移动 过 程 中 ， 其 自身 位 姿 的 不 确定 
性 逐渐 增 大 ， 如 图 中 直径 不 断 增 大 的 椭圆 所 示 。 同 时 
它 检测 到 附近 的 地 标 ， 并 对 它们 建 图 ， 建 图 的 不 确定 
性 结合 了 固定 的 测量 不 确定 性 和 逐渐 增 大 的 位 姿 不 确 
定性 ， 因 此 地 标 位 置 的 不 确定 性 随时 间 增 大 。 有 趣 的 
转变 如 图 37. 2d 所 示 : 此 时 机 器 人 观测 到 了 它 在 最 开 
始 建 图 时 看 到 的 那个 地 标 ， 其 位 置 可 相对 准确 地 知 
道 。 通 过 这 次 观测 ， 机 器 人 位 姿 误 差 减 小 了 ， 如 图 
37. 2d 所 示 ， 注 意 对 于 最 后 的 机 器 人 位 姿 误 差 椭圆 很 
小 。 这 一 观测 也 降低 了 地 图 中 其 他 地 标的 不 确定 性 。 
该 现象 是 由 以 高 斯 后 验 协 方差 矩阵 表示 的 相关 性 产生 
的 。 由 于 较 早 的 地 标 估 计 的 主要 不 确定 性 由 机 器 人 位 
姿 引 起 ， 并 且 这 一 不 确定 性 一 直 持续 ， 因 此 这 些 地 标 
的 位 置 估计 相关 。 当 获得 机 器 人 的 位 姿 信息 时 ， 这 一 
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移动 式 和 分 布 式 机 器 人 技术 


信息 会 传递 给 先前 观测 到 的 地 标 。 这 种 效果 可 能 是 


SLAM 后 验 最 重要 的 特征 "| 。 帮 助 定位 机 器 人 的 信 


— 4 
. e @ 


a) 


c) 


,通过 地 图 传播 ， 从 而 改进 了 地 图 中 其 他 地 标的 


d) 


图 37.2 用 于 在 线 SLAM 问题 的 EKF。 机 器 人 的 运动 轨迹 如 虚线 所 示 ， 它 们 自身 的 位 置 估计 用 阴影 椭圆 表 

示 ，8 个 位 置 未 知 的 可 辨别 的 地 标 用 小 圆 点 表示 ， 它 们 的 位 置 估 计 用 白色 椭圆 表示 。 在 图 a) ~ 图 c) 中 ,机 

器 人 定位 的 不 确定 性 和 它 看 到 的 地 标的 不 确定 性 都 逐渐 增 大 。 在 图 d ) 中 ,机 器 人 再 次 观测 到 第 一 个 地 标 ， 
因此 所 有 地 标的 不 确定 性 和 当前 位 姿 的 不 确定 性 都 减 小 了 (图 由 斯 坦 福 大 学 Michael Montemerlo 提供 ) 


EKF SLAM 也 处 理 数据 关联 问题 。 如 果 被 观测 特 
征 未 知 ， 则 基本 EKF 就 不 适用 了 。 解 决 的 办 法 是 在 
观测 到 地 标 时 推断 最 可 能 的 数据 关联 。 数 据 关联 通常 
基于 接近 程度 判断 : 地 图 中 哪个 地 标 最 有 可 能 与 刚刚 


由 水 下 机 器 人 Oberon 获得 的 水 下 地 图 。 该 机 器 人 由 
澳大利亚 悉尼 大 学 人 研制， 如 图 37. 3b 所 示 ， 装 有 笔 形 
波束 的 机 械 扫描 声呐 ， 它 可 以 产生 50m 开外 的 目标 
的 高 分 辨 率 的 距离 和 方位 测量 。 为 便于 建 图 ， 研究 人 


观测 到 的 地 标 对 应 ? 接近 度 计算 考虑 测量 噪声 和 后 验 
估计 中 实际 存在 的 不 确定 性 ， 并 用 马 氏 距离 ( Mahal- 
anobis distance) 作为 度量 ， 马 氏 距 离 是 一 种 加 权 二 
次 距离 。 为 尽量 减少 虚假 数据 关联 ， 许 多 实现 都 采用 
可 视 特征 区 分 各 个 地 标 并 对 同时 观测 到 的 地 标 组 进行 
关联 目前 的 实现 还 维护 一 张 临时 地 标 表 ， 
只 将 足够 多 次 观测 到 的 地 标 添 加 到 内 部 地 图 
中 WY 。 借助 适当 的 地 标定 义 和 数 据 关 联 方 法 的 
慎重 实现 ，EKF SLAM 成 为 一 种 基于 特征 SLAM 的 有 
效 方法 。 

EKF SLAM 已 成 功 应 用 于 各 种 导航 问题 ， 包 括 机 
载 、 水 下 、 室 内 和 各 种 其 他 车 辆 。 图 37. 3a 给 出 了 
EKF SLAM 的 一 个 高 水 平实 现 获 得 的 示例 结果 ， 一 张 


员 在 水 中 放置 了 细 长 的 垂直 物体 ， 它 们 可 以 被 相对 容 
易 地 从 声呐 扫描 中 提取 出 来 。 在 这 个 实验 中 ， 有 一 排 
这 样 的 间距 约 10m 的 物体 。 此 外 ， 更 远 处 的 悬崖 额 
外 提供 了 可 用 扫描 声呐 检测 的 点 特征 。 

在 图 37. 3a 所 示 的 地 图 中 ， 机 咒 人 的 轨迹 用 由 
线 连接 的 三 角形 标记 。 每 个 三 角形 周围 的 椭圆 对 应 
着 投影 到 机 器 人 位 姿 〈 空 间 ) 的 卡尔 曼 滤 波 估计 的 
WIZER. MARKI, CEANU AEA 
的 位 姿 越 不 确定 。 图 37. 3a 中 的 各 小 圆 点 表示 通过 
搜索 声呐 扫描 中 的 小 型 高 反射 物体 获得 的 地 标 观测 ， 
借助 统计 异常 排斥 技术 多 数 观测 会 被 丢弃 ”“” S, gig 
被 确认 对 应 地 标的 观测 则 被 添加 到 地 图 中 。 运 行 结 
RHET, BLAS ACK 14 个 这 样 的 物体 划分 为 地 标 ， 这 些 
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物体 和 其 估计 的 不 确定 椭圆 一 起 在 图 37. 3a 中 画 出 。 
这 些 地 标 包括 人 研究 人 员 放 置 的 人 工地 标 ， 也 包括 机 
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Ecl 
。 地 图 特征 
一 车辆 罗 迹 


a) 


项 人 附近 的 各 种 其 他 地 形 特征 。 残 留 的 姿态 不 确定 
性 很 小 。 


图 37.3 a) 用 卡尔 曼 滤 波 估计 地 图 和 车 辆 位 姿 示 例 b) 悉尼 大 学 研发 的 水 下 机 器 人 Oberon 
(图 片 由 澳大利亚 野外 机 器 人 学 中 心 的 Stefan Williams 和 Hugh Durrant- Whyte 提供 ) 


EKF SLAM 的 基本 公式 假设 地 图 特征 的 位 置 从 
一 个 机 器 人 位 姿 完全 可 观测 。 该 方法 已 被 扩展 到 只 
具有 部 分 可 观 性 的 情形 ， 如 只 测量 距离 2 k R 
Efa RECT MS) 。 该 方法 也 被 用 于 无 特征 表示 的 情 
JE. 状态 由 当前 和 过 去 的 机 器 人 位 姿 构 成 ,测量 取 
为 位 姿 间 的 约束 (如 从 激光 扫描 匹配 或 摄像 机 测量 
得 出 ) [37.26,27] E 

将 EKF 方法 用 于 SLAM 的 一 个 主要 问题 在 于 协 
方差 矩阵 的 二 次 性 。 一 些 研 究 者 提出 了 EKF SLAM 的 
扩展 算法 ， 他 们 将 地 图 分 解 为 多 个 子 图 并 分 别 维护 它 
们 的 协 方差 矩阵 ， 获 得 了 显著 的 可 扩展 性 ， 相 关 文 献 
见 参考 文献 【37. 19，28-32] 。 其 他 研究 人 员 将 EKF 
类 SLAM 方法 与 体积 地 图 表示 相 结合 ， 提 出 了 混合 
SLAM 方法 ， 见 参考 文献 [37.33-36]。 此 外 ， 研 究 
者 基于 先进 的 统计 技术 如 Dempster 的 最 大 似 然 (EM) 
算法 人 提出 了 用 于 SLAM 的 数据 关联 方法 ”1。 


基于 图 的 优化 方法 


第 二 类 算法 通过 非 线性 稀 朴 优化 解决 SLAM 问 
题 ， 思 路 源 于 SLAM 问题 的 图 形 表示 。 基 于 图 的 方法 
首先 在 参考 文献 [37.8, 41] 中 被 提 及 ， 但 开创 性 


37. 3.2 


全 SLAM 问题 。 

基于 图 的 SLAM 算法 的 基本 思路 如 下 。 可 将 地 标 
和 机 器 人 位 姿 看 做 图 的 节点 ， 每 对 连续 的 位 姿 x s, 
x, 由 表示 里 程 计 读数 u, 所 传达 的 信息 的 弧 连 接 。 若 
在 时 刻 t 机 器 人 观测 到 地 标 i， 则 位 姿 x, 和 地 标 m, 间 
也 存在 弧 连 接 。 这 个 图 中 的 弧 是 软 约束 ， 放 宽 这 些 约 
束 可 产生 地 图 和 完整 轨迹 的 最 佳 估计 。 
图 的 构建 如 图 37.4 所 示 。 假 设 在 ; = 1 时 刻 机 器 
人 检测 到 地 标 m, ， 就 在 (还 很 不 完整 的 ) 图 中 的 x 
Alm, 之 间 添 加 一 个 弧 。 当 将 弧 存 储 为 矩阵 形式 CIE 
恰好 对 应 定义 所 产生 的 约束 的 二 次 方程 ) 时 ， 则 给 
x, Alm, 之 间 的 元 素 添加 一 个 值 ， 如 图 37. 4a 右 侧 
所 示 。 

现在 假设 机 器 人 移动 ， 里 程 计 读数 u, 导致 节点 
x, Ax, 之 间 存 在 弧 ， 如 图 37. 4b 所 示 。 连 续 使 用 这 
两 个 基本 步骤 会 得 到 一 张 逐渐 增 大 的 图 ， 如 图 37. 4c 
所 示 。 然 而 这 张 图 是 稀疏 的 ， 图 中 每 个 节点 只 与 少量 
的 其 他 节点 相连 ， 图 中 约束 的 数目 (最 差 ) 与 经 过 
的 时 间 和 图 中 的 节点 数 呈 线性 关系 。 

若 将 图 看 做 弹簧 一 质量 块 模型 97 SLAM 求解 
等 价 于 求 该 模型 的 最 小 能 量 状 态 。 为 看 清 这 一 点 ， 注 


的 论文 是 参考 文献 [37.42]， 它 提供 了 第 一 个 有 效 
的 解决 方案 。 本 节 内 容 与 一 系列 近期 的 论文 密切 相 
关 ”?” 1。 我 们 注意 到 ， 尽 管 存在 一 些 下 文 将 讨论 
的 在 线 方法 ， 当 前 多 数 方法 都 是 离线 的 ， 解决 的 是 完 


意 该 图 对 应 完全 SLAM 问题 的 后 验 概率 分 布 的 对 数值 
(对 照 式 (37. 4) ) 

logp( X, , m |Z,,U,) 
上 式 具 有 如 下 形式 : 


(37.11) 
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a) 


Xp Xs nm 


b) 


XQ X) Xa X, M Hoo M, My 


通常 的 选择 包括 梯度 下 降 法 (gradient descent) 、 共 
HEI (conjugate gradient) 等 。 多 数 SLAM 实现 
都 依赖 于 函数 g Ah 的 某 种 迭代 线性 化 ， 此 时 式 
(37.14) 中 的 目标 函数 对 它 的 所 有 变量 都 是 二 次 的 。 
图 方法 很 容易 扩展 来 处 理 数据 关联 问题 ， 这 是 由 于 
式 (37.14) 很 容易 扩展 为 结合 附加 的 数据 关联 知识 。 
假定 某 个 智者 告诉 我 们 地 图 中 的 地 标 m, 和 m; 是 环境 中 
的 同一 个 物理 地 标 ， 那 么 我 们 可 以 将 m; 从 图 中 去 掉 ， 
并 将 其 所 有 邻接 弧 连 到 m, 上 ， 也 可 以 添加 一 个 如 下 形 
式 的 软 一 致 性 约束 (soft correspondence constraint)! 
[m -mi] Tlm, -mi] (37.15) 
式 中 , 厂 为 2x2 对 角 和 矩阵 ， 其 对 角 系 数 决定 了 对 没 
有 将 同样 的 位 置 分 配给 两 个 地 标的 惩罚 (因此 我 们 
希望 本 大 )。 由 于 图 方法 通常 用 于 完全 SLAM 问题 ， 
优化 可 以 与 最 优 数据 关联 的 搜索 交错 进行 。 最 先进 的 


图 37.4 图 的 构造 说 明 ， 左 侧 表示 图 ， 右 侧 给 出 了 
矩阵 形式 的 约束 
a) 观测 到 地 标 m， b) 机 器 人 从 xi 运动 到 x， c) 几 步 之 后 


logp( X»,m |Z;,U;) = const + > logos, |x, ) 


十 Y logp(z, |x, , m) 
(37.12) 
形式 为 logp(x, lx, u,) 的 每 一 个 约束 正好 是 一 个 
机 右 人 运动 事件 的 结果 ， 并 对 应 图 中 的 一 个 弧 。 同 
样 ， 形 式 为 logp (z, lx, m) 的 每 个 约束 是 一 次 传 感 
器 测量 的 结果 ， 在 图 中 也 可 以 找到 一 个 与 之 对 应 的 
弧 。 则 SLAM 问题 就 是 寻找 该 方程 的 如 下 状态 
X/ m" zargmax,, , logp( X, ,m |Z,,U,) (37.13) 
我 们 注意 到 ， 在 点 地 标示 例 中 所 做 的 高 斯 噪声 假设 
下 ， 该 表达 式 可 分 解 为 如 下 二 次 形式 : 


logp( X, m |Z;,U,) = const + Y, [x, - g(x,,,u) ]' 


R;'[x, -g(x ,,u,)] 
十 > [z - h(x,,m) ]* 


t 


Q; [ z, d h(x,,m) ] 
(37.14) 
MKR, VRAIN HE TIE ABT JH 


=k 


这 是 


实现 依赖 于 随机 抽样 一 致 性 (RANSAC) 77" s xx 
定 界 方法 (branch-and-bound methods) 9135,56] a 

图 形 SLAM 方法 的 优势 在 于 它们 可 以 扩展 到 比 
EKF SLAM 维 数 高 得 多 的 地 图 。EKF SLAM 的 主要 制 
约 因素 是 协 方差 矩阵 ， 它 所 占 空 间 (和 更 新 时 间 ) 
均 为 地 图 大 小 的 二 次 方 ， 图 方法 不 存在 这 样 的 限制 。 
图 的 更 新 时 间 为 常数 ， 所 需 存 储量 与 地 图 大 小 呈 线 性 
关系 〈 在 一 些 适 度 的 假设 下 ) ， 但 执行 优化 花 销 很 
大 。 虽 然 实际 上 合理 分 配 的 数目 通常 很 小 ， 但 从 技术 
上 ， 寻 找 最 优 数据 关联 被 视 为 NP 难题 。 除 其 他 原因 
Dh, SX (37.14). 的 对 数 似 然 函数 的 连续 优化 取决 于 
地 图 中 闭环 的 数目 和 大 小 。 

图 37.5 给 出 了 基于 约束 图 分 析 和 最 佳 数据 关联 
PRESS RY CHEN SLAM 算法 的 结果 。 地 图 数据 由 
CMU 研制 的 用 于 探测 废弃 的 地 下 矿井 并 建 图 的 
Groundhog 机 器 人 获取 527?1 | Groundhog 机 器 人 配备 
了 激光 测 距 仪 ， 可 沿 环境 的 水 平 切片 测量 障碍 物 的 距 
离 。 所 示 地 图 覆盖 了 250m x 150m 的 区 域 ， 其 形式 为 
最 早 由 Elfes 和 Moravec 提出 的 占据 栅 格 地 图 ( occu- 
pancy grid map) 5 5。 占据 栅 格 地 图 用 贝 叶 斯 推理 
估计 栅 格 为 空 的 后 验 概 率 ， 因 此 容许 测 距 仪 有 噪声 。 
作为 一 个 比较 基准 ， 图 37. 5a 给 出 了 一 个 用 简单 
得 多 的 方法 构造 的 地 图 : 将 当前 扫描 相对 于 略 早 前 的 
扫描 进行 定位 ,一旦 定位 成 功 ， 就 假设 估计 的 位 姿 正 
确 将 当前 扫描 添加 到 地 图 中 。 这 一 方法 被 称 作 扫 描 匹 
配 (scan matching ) 2724。 扫描 匹配 是 一 种 SLAM 算 
法 ， 但 只 适用 于 位 姿 不 确定 性 非常 小 的 情况 ， 由 图 
37. 5a 可 知 闭环 失败 是 显然 的 。 事实 上 ， 可 将 成 对 扫 
描 匹配 看 做 一 种 图 形 SLAM 算法 ,但 只 在 紧邻 的 扫描 
间 建 立 对 应 关系 (并 在 图 中 插入 约束 )。 
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为 将 这 些 数据 映射 到 一 个 规模 可 管理 的 图 中 ,该 算 。 描 匹 配 可 完美 执行 ， 所 以 地 图 足够 精确 。 每 个 子 图 成 为 


法 将 地 图 分 解 为 小 的 局 部 子 图 ， 


每 个 子 图 对 应 机 器 人 
5m 的 行程 。 在 这 Sm 范围 内 ， 由 于 一 般 的 漂移 小 从 而 扫 


图 形 SLAM 中 的 一 个 姿态 节点 ， 相 邻 的 子 图 通过 它们 之 
间 的 相对 运动 约束 连接 ， 结 果 如 图 37. 5b 所 示 。 


RR 


图 37.5 一 个 废弃 的 矿井 的 占据 栅 格 地 图 


) 增 量 式 佑 计数 据 关联 ， 只 参考 最 新 


的 传感器 测量 b) 全 局 数据 关联 和 图 优化 的 结 


(图 片 由 弗 赖 堡 大 学 的 Dirk Hähnel 提供 ) 


在 这 幅 图 上 ， 就 可 以 进行 分 支 定 界 一 致 性 递归 搜 
索 了 。 为 找到 可 能 对 应 的 优良 子 图 ， 此 算法 对 重 公 的 
两 个 地 图 进行 相关 性 分 析 。 一 旦 发 现 两 个 相配 的 图 ， 
就 将 一 个 形 如 式 (37.15) 的 软 约束 添加 到 图 中 ， 紧 
接着 对 得 到 的 约束 集 进行 优化 。 图 37.6 说 明了 数据 


关联 过 程 : 每 个 圆 对 应 搜索 过 程 中 发 现 的 一 个 新 约 
束 。 此 图 说 明了 搜索 的 迭代 性 质 ， 一 些 对 应 关系 仅 在 
其 他 对 应 在 搜索 过 程 中 确定 后 才能 被 发 现 。 最 终 的 模 
型 是 稳定 的 ， 即 附加 的 新 数据 关联 搜索 不 再 引入 进 一 
步 的 改变 。 图 37. Sb 给 出 了 得 到 的 栅 格 地 图 。 


PY 
T 


图 37.6 数据 关联 搜索 。 见 正文 
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其 他 基于 图 的 SLAM 方法 得 到 了 类 似 的 结果 。 
图 37.7 给 出 了 用 Auas 算法 作用 于 同样 的 数据 集 产 生 
的 地 图 ， 该 算法 将 地 图 分 解 为 子 图 ， 子 图 间 的 


关系 通过 信息 理论 的 相对 连接 来 保持 。 
优化 的 全 局 地 图 


100 


—50 0 50 100 150 200 


图 37.7 由 参考 文献 [37. 26 ] 中 的 Atlas SLAM 算法 
产生 的 矿井 地 图 ( 由 Bosse 等 人 提供 ) 


需要 注意 的 是 ， 基 于 图 的 方法 与 信息 理论 有 着 非 
常 紧 密 的 联系 ， 其 中 软 约 束 构成 了 环境 中 机 器 人 具有 
的 信息 〈 在 信息 理论 意义 上 ) ， 该 领域 的 多 数 方法 本 


下 ， 当 粒子 集合 的 大 小 趋 于 无 穷 时 粒子 滤波 器 可 以 通 
近 真 实 的 后 验 概率 分 布 。 它 也 是 一 种 易于 表示 多 模 分 
布 的 非 参数 表示 。 近 年 来 ， 极 为 有 效 的 微 处 理 器 的 出 
现 使 粒子 滤波 器 成 为 一 种 主流 算法 "|。 

粒子 滤波 器 用 于 SLAM 的 主要 问题 是 表示 地 图 和 
机 器 人 轨迹 的 空间 巨大 。 假 设 有 一 张 1000 个 特征 的 
地 图 ， 需 要 多 少 粒 子 来 填充 这 一 空间 呢 ? 事实 上 ， K 
子 滤波 器 的 规模 与 基本 状态 空间 的 维 数 成 指数 关系 ， 
因此 三 维 或 四 维 是 可 以 接受 的 , 但 100 维 一 般 不 能 
接受 。 

使 粒子 滤波 器 适用 于 SLAM 问题 的 方法 可 追溯 到 
参考 文献 [37. 75，76] 。 参 考 文献 [37.77] 和 参考 
文献 [37.78] 先后 将 这 种 方法 引入 SLAM， 后 者 提 
出 了 FastSLAM。 我们 先 以 简化 的 点 特征 示例 解释 基 
本 的 FastSLAM 算法 ， 然 后 讨论 采用 这 一 方法 的 理由 。 

在 任 一 时 刻 ，FastSLAM 维持 如 下 形式 的 天 个 
粒子 : 


XM sia Vu Xue (37.16) 
式 中 , [k] 是 样本 编号 。 这 一 表达 式 说 明 每 个 粒子 
包含 
1) 一 个 样本 轨迹 XI。 
2) 一 个 均值 为 ji 、 方 差 为 了 中 的 NN 个 二 维 高 


质 上 都 是 离线 的 ， 即 它们 优化 整个 机 器 人 轨迹 。 如 果 
机 器 人 轨迹 很 长 ， 优 化 就 可 能 很 麻烦 。 这 是 基于 图 形 
方法 的 缺点 之 一 。 还 有 一 些 交叉 方法 通过 在 线 处 理 图 来 
管理 过 去 的 机 器 人 位 姿 变 量 , 所 得 算法 为 滤波 
器 ?< ， 并 往往 与 信息 滤波 方法 密切 相关 55。 
许多 试图 将 EKF SLAM 表示 分 解 为 较 小 子 图 以 扩大 规 
模 的 方法 都 与 图 方法 有 类 似 的 动机 ， 见 参考 文献 
[37.29, 30, 68]. 

在 写 这 一 章 的 时 候 ， 基 于 图 形 和 优化 的 SLAM 算 
法 是 正在 深入 研究 的 课题 。 最 近 的 结果 表明 该 方法 将 
规模 扩展 到 具有 108 74S BERE B jo [e| 07-269 35。 
可 以 说 ， 基 于 图 形 的 方法 已 经 产生 了 一 些 有 史 以 来 最 
大 的 SLAM 地 图 ， 但 通常 是 离线 的 。 


37.3.3 粒子 方法 


第 三 类 基本 SLAM 方法 基于 粒子 滤波 器 。 粒 子 滤 
波 器 可 以 追溯 到 参考 文献 [37.69]， 但 仅 在 近 些 年 
才 成 为 主流 。 粒 子 滤 波 器 通过 一 个 粒子 集合 来 表示 后 
验 概率 。 对 于 研究 SLAM 的 新 手 来 说 ， 最 好 将 每 个 粒 
子 看 做 是 对 状态 真实 值 的 一 个 具体 猜测 。 粒 子 滤波 器 
将 这 些 猜测 集中 到 一 个 猜想 集合 或 粒子 集合 中 ， 由 后 
验 分 布 得 到 一 个 代表 性 的 采样 。 已 证 明 在 适当 的 条 件 


斯 集合 ， 每 个 代表 环境 中 的 一 个 路 标 。 

其 中 , n (1 <n < N) 是 路 标的 编号 。 可 见 天 个 粒 
子 拥有 天 个 轨迹 样本 和 KN 个 高 斯 分 布 ， 每 个 高 斯 分 
布 恰好 对 一 个 粒子 的 一 个 路 标 进行 了 建 模 。 
FastSLAM 的 初始 化 很 简单 : 只 需 将 每 个 粒子 的 
机 需 人 位 姿 设 置 为 它 的 已 知 起 始 坐 标 ， 地 图 设 为 零 。 
然后 进行 如 下 粒子 更 新 : 

1) 当 收 到 一 个 新 的 里 程 计 读数 时 ， 为 每 个 粒子 
随机 产生 一 个 新 的 位 姿 变量 。 产 生 这 些 位 姿 粒 子 的 分 
布 基 于 如 下 运动 模型 

xi^ ~ p(x, xl ju’) (37. 17) 
RP, xj ERE ES, FER PBS, 3X 
一 步 概率 采样 对 任何 运动 学 可 计算 的 机 器 人 都 容易 
实现 。 

2) 当 收 到 一 个 测量 值 z, 时 ， 有 两 件 事 发 生 : 首 
先 ，FastSLAM 为 每 个 粒子 计算 新 测量 为 z, 的 概率 。 
令 检测 到 的 路 标的 编号 为 nx， 则 理想 的 概率 如 下 
定义 


ol: = Nz lf" at, xj (37.18) 
由 于 因子 ol 根据 新 的 传感器 测量 对 粒子 的 重要 性 
进行 了 度量 ， 因 此 被 称 作 重要 性 权重 (importance 
weight) 。 同 前 , .NH 仍 表 示 正 态 分 布 ， 但 此 时 计算 的 是 
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一 个 特定 值 z, 的 分 布 。 然 后 ， 将 所 有 粒子 的 重要 性 
权重 归 一 化 ， 使 它们 的 和 为 1。 

接 下 来 ，FastSLAM 从 存在 的 粒子 集中 提取 一 个 
新 粒子 集 (代替 原 有 的 粒子 集 ) 。 提 取 一 个 粒子 的 概 
率 就 是 它 的 归 一 化 的 重要 性 权重 。 这 步 被 称 作 重 采样 
(resampling) 。 重 采样 的 道理 很 简单 : 观测 值 更 可 信 
的 那些 粒子 有 更 高 的 机 会 经 过 重 采样 后 保留 下 来 。 最 
后 ，FastSLAM 基于 观测 z, 为 新 粒子 集 更 新 均值 u^ 
和 协 方差 一。 这 一 更 新 遵循 标准 的 EKF 更 新 规则 。 

这 一 切 似乎 很 复杂 ,但 FastSLAM 很 容易 实现 。 
由 于 只 涉及 简单 的 运动 学 计算 ， 从 运动 模型 采样 通 
常 很 容易 。 计 算 一 个 观测 的 重要 性 也 不 复杂 ， 尤 其 
是 对 高 斯 测量 噪声 。 更 新 低 维 的 粒子 滤波 器 也 简单 。 
这 使 FastSLAM 成 为 目前 可 行 的 最 容易 实现 的 算法 
vu 

已 证 明 FastSLAM 3& irse 4 SLAM 的 后 验 概率 分 
布 。FastSLAM 算法 的 得 出 利用 了 三 项 技术 : Rao- 
Blackwellization, 4% fF 3h Xz AN BE HK KE, Rao- Black- 
wellization 的 概念 如 下 : 假定 我 们 要 计算 概率 分 布 
pia, b), EPa 和 4。 为 任意 随机 变量 。 普通 的 粒子 
滤波 器 会 根据 联合 分 布 提取 粒子 ， 即 每 个 粒子 都 有 一 
个 a 的 值 和 一 个 5b 的 值 。 然 而 ,如果 条 件 概 率 分 布 
p(b a) 可 描述 为 封闭 形式 ， 则 仅 从 p(a) 提取 粒子 并 
给 每 个 粒子 附加 一 个 p(bla) 的 封闭 形式 的 描述 同样 
合理 。 这 就 是 所 谓 的 Rao- Blackwellization， 其 结果 优 
于 从 联合 分 布 采 样 。FastSLAM 采用 该 方法 ， 根 据 轨 
迹 的 后 验 概率 分 布 p(XI" |U,, Z,) 采样 ， 并 以 高 斯 


图 37.8 用 贝 叶 斯 网 图 (Bayes network graph ) 
描述 的 SLAM 问题 


机 器 人 位 姿 已 知 ， 地 图 中 任何 两 个 特征 之 间 没 有 包含 
未 知 变量 的 其 他 轨迹 ， 这 使 得 地 图 中 任何 两 个 特征 的 
后 验 概 率 都 是 条 件 独 立 的 〈 给 定位 姿 ) 。 

我 们 还 注意 到 FastSLAM 使 用 粒子 滤波 器 。 粒 子 

滤波 器 的 推导 可 在 上 述 参考 文献 中 找到 。 在 这 里 要 指 
出 的 是 ， 运 动 和 测量 两 步 都 保持 了 从 完全 SLAM 的 后 
验 概率 分 布 渐 近 提 取样 本 的 性 质 。 对 运动 更 新 步骤 这 
一 点 很 显然 。 对 测量 步骤 ， 该 性 质 通 过 重 采样 得 以 保 
留 ， 重 采样 根据 测量 提供 的 新 的 信息 调整 粒子 数量 和 
分 布 。 
图 37. 9 给 出 了 点 特征 问题 的 结果 ， 这 里 点 特征 
为 室外 机 器 人 观测 到 的 树干 的 中 心 ， 采 用 的 是 维 多 利 
NEZ bU. p 37. 9a 表明 ， 在 没有 感知 控 
制 的 情况 下 ， 对 机 器 人 的 控制 量 进行 积分 得 到 的 机 器 
人 的 运动 轨迹 ， 是 一 个 差 的 车 辆 位 置 预 测 ; 行驶 
30min 后 ， 车 辆 的 估计 位 置 偏离 它 的 GPS 位 置 超 
过 100m, 


形式 表示 地 图 p(m |X", U,, Z,)o 

FastSLAM 还 将 地 图 的 后 验 (以 轨迹 为 条 件 ) 分 
解 为 低 维 的 高 斯 序列 。 这 样 分 解 的 理由 很 巧妙 。 它 产 
EF SLAM 特有 的 条 件 独立 假设 。 图 37.8 用 图 解法 
说 明了 这 一 概念 。 在 SLAM 中 ， 机 器 人 轨迹 的 知识 使 
所 有 地 标的 估计 独立 ， 对 图 37.8 的 图 形 网 络 这 一 点 
很 容易 证 明 : 如 果 从 图 中 移 去 轨迹 变量 ， 则 地 标 变 量 
就 都 断 开 了 ?1 。 因 此 ,在 SLAM 中 多 个 地 标 估计 
间 的 任何 依赖 关系 都 是 通过 机 器 人 轨迹 间接 产生 的 。 
这 一 细微 但 重要 的 观察 意味 着 ， 即 使 用 一 个 大 的 、 整 
体高 斯 表示 整个 地 图 ( 当然， 每 个 粒子 一 个 ) ， 不 同 
地 标 之 间 的 非 对 角 元 素 只 会 保持 为 零 。 因 此 可 以 用 NV 
个 小 高 斯 ， 每 个 地 标 一 个 ， 更 有 效 地 实现 地 图 。 这 和 解 
FET FastSLAM 中 的 有 效 地 图 表示 。 

如 图 37. 8 所 示 ， 机 器 人 在 控制 序列 的 作用 下 从 
PE x, JEL x, 5. FERAL x, 处 机 器 人 观 
测 到 地 图 m={m,, m, m} 的 一 个 特征 。 此 图 形 网 
络 说 明 ， 位 姿 变 量 将 地 图 中 的 各 个 特征 彼此 分 开 。 若 


FastSLAM 算法 有 许多 卓越 的 性 质 ， 这 对 非 专 业 
人 员 并 不 直观 。 首 先 ， 它 既 能 解决 完全 SLAM 问题 也 
能 解决 在 线 SLAM 问题 。 每 个 粒子 都 有 一 个 整 条 轨迹 
的 样本 (事实 上 ， 数 学 推导 要 以 这 一 整 条 轨迹 为 条 
fF), 但 实际 更 新 方程 只 用 最 近 的 姿态 。 这 使 
FastSLAM 像 EKF 一 样 是 一 个 滤波 器 。 其 次 ， 
FastSLAM 易于 追踪 多 个 数据 关联 假设 。 它 直接 按 粒 
子 原则 做 数据 关联 决策 ， 而 不 是 对 整个 滤波 器 采用 同 
一 个 假设 。 未 给 出 任何 数学 证 明 ， 我 们 要 指出 的 是 ， 
即使 对 数据 关联 未 知 的 SLAM 问题 ，FastSLAM 算法 
也 能 对 正确 的 后 验 概率 分 布 采样 一 一 这 是 前 两 种 算法 
都 不 具备 的 。 第 三 ，FastSLAM 可 非常 有 效 地 实现 ; 
用 先进 的 树 的 方法 来 表示 地 图 估计 ， 更 新 时 间 与 地 图 
大 小 N 成 对 数 关系 ， 与 粒子 数 M 呈 线 性 关系 。 这 些 
特性 ， 加 上 相对 易于 实施 ， 使 得 FastSLAM 成 为 一 种 
主流 的 选择 。 

FastSLAM 被 以 多 种 方式 进行 了 扩展 。 一 个 重要 
的 变 体 是 基于 栅 格 的 FastSLAM 算法 ， 它 用 栅 格 地 图 
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(occupancy grid map) RAAM, E 37. 10 
和 图 37. 11 对 这 一 算法 进行 了 说 明 。 其 中 图 37. 10 显 
示 了 闭合 一 个 大 环 前 的 情况 ， 三 个 不 同 的 粒子 各 自 代 


a) 


表 不 同 的 轨迹 ， 它 们 也 拥有 各 自 的 局 部 地 图 。 闭 环 
时 ， 重 要 性 重 采 样 选择 地 图 与 测量 最 一 致 的 粒子 。 得 
到 的 一 个 大 规模 地 图 如 图 37. 11 所 示 。 


lil 


E 


图 37.9 a) 根据 里 程 计 预 测 的 未 经 处 理 的 机 器 人 轨迹 b) GPS 真实 轨迹 (虚线) 和 FastSLAM 1.0 轨迹 (K) 
c) 又 加 在 航拍 图 像 上 的 维多利亚 公园 的 结果 : 蓝 色 (虚线 ) 为 GPS 轨迹 ,黄色 (RA) 为 平均 FastSLAM 1.0 轨迹 ， 
黄 点 为 估计 的 特征 (数据 和 航拍 图 像 由 澳大利亚 野外 机 器 人 学 中 心 的 José Guivant 和 Eduardo Nebot 提供 ) 


图 37. 10 基于 栅 格 的 FastSLAM 算法 的 应 用 。 每 个 粒子 带 有 它 自己 的 地 图 ， 在 给 定 粒子 自身 地 图 的 
情况 下 ,粒子 的 重要 性 权重 基于 测量 值 的 可 能 性 计算 


FastSLAM 方法 的 重要 扩展 见 参 考 文献 [37. 82, 
83], HP DP- SLAM 和 祖先 树 (ancestry trees) 为 基 
于 栅 格 的 地 图 提供 了 有 效 的 树 更 新 方法 。 参 考 文献 
[37. 84] 基于 参考 文献 [37. 85] 的 工作 提供 了 一 种 
将 新 观测 加 入 位 姿 采 样 过 程 的 方法 。 


几 类 方法 的 关系 


上 述 讨论 的 三 类 方法 覆盖 了 SLAM 领域 的 绝 大 多 
数 工作 。 如 前 所 述 ，EKF SLAM 由 于 计算 负担 ， 其 规 


37.3.4 


模 严重 受 限 。EKF SLAM 最 有 前 景 的 扩展 是 基于 建立 
局 部 子 图 ， 但 是 多 种 途径 得 到 的 算法 都 与 基于 图 的 方 
法 类 似 。 

基于 图 的 方法 处 理 的 是 完全 SLAM 问题 ， 因 此 本 
质 上 不 是 在 线 方法 。 它 们 从 如 下 观察 中 获得 直觉 : 
SLAM 可 用 软 约束 的 稀 玻 图 建 模 ， 其 中 每 个 约束 要 么 
对 应 一 个 运动 事件 ， 要 么 对 应 一 个 量 测 事件 。 由 于 对 
稀 玻 非 线性 优化 问题 存在 高 度 有 效 的 优化 方法 ， 基 于 
图 的 SLAM 已 经 成 为 离线 建立 大 规模 地 图 的 选择 方 
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法 。 数 据 关 联 搜索 很 容易 并 人 基本 的 数学 框架 ， 并 存 
在 许多 发 现 适 当 的 对 应 的 搜索 方法 。 也 有 将 基于 图 的 
SLAM 扩展 用 于 解决 在 线 SLAM 问题 的 方法 ， 这 些 方 
法 往往 将 旧 的 机 器 人 位 姿 从 图 中 移 除 。 

粒子 滤波 方法 回避 了 困扰 EKF 的 、 由 地 图 中 国 
有 的 特征 间 的 相关 性 产生 的 问题 。 通 过 采样 机 器 人 位 
姿 ， 地 图 中 的 各 个 地 标 变 为 独立 的 ， 从 而 不 相关 。 因 
此 FastSLAM 可 以 用 采样 的 机 器 人 位 姿 和 许多 局 部 的 、 
独立 的 地 标的 高 斯 分 布 来 描述 后 验 概率 分 布 。 


图 37.11 


FastSLAM 的 粒子 表示 有 许多 优点 。 在 计算 上 ， 
FastSLAM 可 用 作 滤 波 器 ， 其 更 新 需要 线性 一 对 数 时 
间 ， 而 EKF 需要 二 次 方 时 间 。 此 外 ，FastSLAM 可 以 
采样 数据 关联 ， 这 使 它 成 为 解决 数据 关联 未 知 的 
SLAM 的 一 个 主要 方法 。FastSLAM 的 缺点 是 ， 所 需 的 
粒子 数 可 能 增长 得 非常 大 ， 尤 其 是 机 器 人 试图 对 多 个 
嵌 套 环 建 图 时 。 我 们 讨论 了 用 栅 格 地 图 而 不 是 高 斯 地 


标的 FastSLAM 的 扩展 方法 ， 并 给 出 了 在 大 规模 地 图 
构建 中 的 最 先进 的 示例 。 


由 激光 距离 数据 产生 的 占据 栅 格 地 图 和 基于 纯粹 的 里 程 计 产生 的 


占据 栅 格 地 图 (所 有 图 片 由 弗 赖 堡 大 学 的 Dirk Hähnel 提供 ) 


37.4 结论 和 未 来 的 挑战 

本 章 给 出 了 SLAM 问题 的 全 面 介绍 和 它 的 主要 方 
法 。SLAM 问题 被 定义 为 未 知 环境 中 的 移动 平台 所 面 
临 的 、 对 移动 平台 进行 定位 同时 对 环境 进行 建 图 的 问 
题 。 本 章 讨论 了 SLAM 中 的 三 类 主要 方法 : 基于 扩展 
卡尔 曼 滤 波 器 、 基 于 图 的 稀 疏 优化 方法 和 粒子 滤波 器 
的 方法 。 指 出 了 这 些 方法 的 优 缺点 。 对 更 深入 的 讨 
论 ， 有 兴趣 的 读者 可 参考 近年 出 版 的 探讨 SLAM 的 教 
BBO) 

有 趣 的 是 ，SLAM 领域 还 相对 年 轻 ， 但 仅 在 过 去 
的 十 年 间 它 取得 了 巨大 进步 。 事 实 上 ， 这 里 描述 的 几 
平 每 种 方法 都 是 在 过 去 几 年 间 发 展 起 来 的 。 尽 管 有 这 
样 的 进步 ， 仍 存在 大 量 未 解决 的 课题 需要 将 来 研究 。 
特别 是 ， 目 前 SLAM 技术 主要 处 理 静态 环境 ， 但 
几乎 每 个 实际 机 器 人 环境 都 是 动态 的 。 将 SLAM 方法 


用 于 动态 环境 的 早期 应 用 可 见 参考 文献 [37. 86- 
88] 。 理 解 SLAM 中 移动 和 非 移动 物体 间 的 相互 作用 
还 需要 更 多 的 工作 。 

多 数 SLAM 工作 研究 的 是 单机 器 人 建 图 问题 ， 但 
有 时 给 定 的 是 一 组 机 器 人 。 关 于 多 机 器 人 SLAM 的 早 
期 的 、 非 常 有 限 的 工作 可 见 参考 文献 [37.89, 90], 
新 近 的 方法 包含 在 参考 文献 [37.91-93] 中 。 近 年 
来 大 量 的 关注 使 多 机 器 人 SLAM 大 大 受益 ， 然 而 现 有 
的 方法 还 没有 成 熟 到 可 以 由 非 领域 内 的 专家 来 使 用 的 
水 平 。 

SLAM 的 一 个 主要 挑战 是 进行 有 实际 意义 的 应 
Hi. HB SLAM 的 理论 发 展 得 相当 完善 ， 但 SLAM 还 
没有 被 广泛 用 于 工业 或 商业 。 目 前 有 前 景 的 技术 原 
型 ,包括 构建 大 规模 三 维 (3-D) 体积 地 图 的 方 
iECOUT S yim Fu 7 09 和 废弃 地 下 矿井 
建 图 小。 然而 为 使 这 些 技 术 成 熟 到 工业 级 应 用 水 
平 还 有 许多 工作 要 做 。 
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最 终 目 标 是 实现 持久 导航 和 建 图 的 挑战 一 一 机 器 
人 在 最 小 人 力 监 督 之 下 ， 在 复杂 的 动态 环境 中 ， 几 
天 、 儿 个 星期 或 几 个 月 鲁 棱 执行 SLAM 的 能 力 。 取 极 
BR too 对 当前 大 多 数 算法 都 提出 了 严峻 的 挑战 。 事 
实 上 ， 随 着 时 间 的 推移 大 多 数 机 器 人 建 图 和 导航 算法 
注定 要 失败 ， 因 为 误差 会 不 可 避免 地 累积 。 需 要 进行 
研究 以 开发 出 能 从 错误 中 恢复 的 技术 ， 使 机 器 人 能 处 
理 环境 变化 并 从 错误 中 恢复 ， 使 机 器 人 能 长 期 自主 
生存 。 


a 


Tin 
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第 38 章 基于 行为 的 系统 


Maja J. Matari'c, Francois Michaud 


REX 


自然 界 中 存在 大 量 能 够 处 理 现 实 世 界 中 各 种 多 
样 性 、 不 可 预测 性 和 快速 变化 情况 的 自主 生物 。 这 
些 生物 体 必须 能 够 在 非 完 整 感知 、 有 限时 间 、 有 限 
知识 ， 并 且 仅 能 获得 非常 有 限 的 其 他 个 体 发 出 的 提 
示 的 情况 下 ， 做 出 正确 的 决策 并 执行 下 一 步 动作 。 
因此 ， 评价 自 主 生物 体 的 智能 水 平 可 以 通过 其 处 理 
复杂 现实 环境 的 能 力 来 衡量 。 本 章 的 主要 目的 是 曾 
明基 于 行为 的 (behavior- based) 系统 的 基本 原理 ， 
以 及 它们 在 单机 需 人 系统 和 多 机 器 人 系统 中 的 
应 用 。 

本 章 的 组 织 结构 安排 如 下 : 

38.1 节 对 机 器 人 控制 进行 综述 ， 分 析 了 基于 
行为 的 系统 与 现存 的 机 器 人 控制 方法 之 间 的 关系 。 
38.2 节 概 述 了 基于 行为 系统 的 基本 原则 ， 使 其 与 
其 他 类 型 的 机 器 人 控制 结构 区 分 开 来 。38.3 T2 
出 基本 行为 (basis behavior) 的 相关 概念 ， 以 及 基 
于 行为 系统 的 模块 化 方法 。38. 4 节 描 述 了 在 基于 
行为 系统 中 行为 是 如 何 用 来 为 表示 法 建 模 的 ,使 机 
右 人 对 环境 和 其 自身 进行 推理 。38.5 XR T 
种 不 同 的 用 于 单机 器 人 和 多 机 器 人 系统 的 基于 行为 


38.1 机 器 人 控制 方法 


情境 机 器 人 学 的 研究 对 象 是 这 样 一 类 机 器 人 ， 它 
们 的 工作 环境 非常 复杂 而 且 频 繁 动 态 变化 。 所 谓 情 
境 ， 是 指 一 个 复杂 、 动 态 变 化 旦 对 行为 影响 极 大 的 环 
境 。 与 此 相反 ， 如 果 机 器 人 处 在 一 个 静态 不 变 的 环境 
中 ， 我 们 就 不 用 去 考虑 情境 ， 例 如 装配 机 咒 人 。 装 配 
机 器 人 通常 用 于 完成 特定 的 操作 ， 它 的 工作 环境 虽然 


W 


系统 的 学 习 方法 。38.6 节 概 述 了 各 种 成 功 应 用 基 
于 行为 控制 的 机 天 人 学 问题 和 应 用 领域 。38.7 节 
对 本 章 进行 总 结 。 
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并 执行 动作 的 过 程 。 环 境 的 复杂 程度 ， 即 情境 水 平 ， 
对 控制 方法 的 复杂 度 有 直接 的 影响 。 关 于 机 器 人 控制 
结构 方面 的 内 容 详 见 本 手册 第 8 章 。 目 前 ， 机 器 人 控 
制 方法 很 多 ， 一 般 可 以 分 为 四 类 ， 具 体 分 析 如 下 。 


在 愤 思 式 体系 结构 中 ， 机 器 人 利用 一 切 可 利用 的 
感知 信息 和 内 部 存储 的 所 有 知识 来 推断 出 下 一 步 该 采 
取 何 种 动作 。 通 常 利用 决策 过 程 中 的 功能 分 解 来 组 织 


38.1.1 


复杂 ， 但 该 环境 却 是 固定 不 变 、 高 度 结构 化 且 易 于 预 
测 的 。 工 作 环境 的 可 预测 性 及 稳定 性 将 直接 影响 到 机 
器 人 控制 的 复杂 程度 。 因 此 ， 人 情境 机 器 人 是 一 个 具有 
巨大 挑战 性 的 研究 课题 。 

机 絮 人 控制 (机 器 人 决策 或 机 器 人 计算 架构 ) 
是 指 感知 环境 信息 、 处 理 信息 、 决 策 (选择 动作 ) 


慎 思 式 体系 结构 ， 包 括 信息 处 理 、 环 境 建 模 、 任 务 规 
划 、 效 用 评判 以 及 动作 执行 等 模块 "| 。 功 能 分 解 模 
式 使 其 适 于 执行 复杂 操作 ， 但 这 意味 着 各 模块 之 间 存 
在 着 强烈 的 序 吐 依赖 关系 。 

慎 思 式 体系 结 构 中 的 推理 以 典型 的 规划 形式 存 
在 ， 它 需要 搜索 各 种 可 能 的 状态 一 动作 序列 并 对 其 产 
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生 的 结果 进行 评价 。 规 划 是 人 工 智能 的 重要 组 成 部 
分 ， 是 一 个 复杂 的 计算 过 程 ， 此 过 程 需要 机 融 人 执行 
个 感知 一 规划 一 动作 的 步骤 (例如 ， 将 感知 信息 
融入 到 世界 地 图 中 ， 然 后 利用 规划 模块 在 地 图 上 寻找 
路 径 ， 最 后 向 机 器 人 的 执行 机 构 发 出 规划 的 动作 步 
骤 )*”。 机 器 人 制订 规划 ， 并 对 所 有 可 行规 划 进 
行 评价 ， 直 至 找到 一 个 能 够 到 达 目 标 、 解 决 任务 的 合 
理 规划 。 第 一 个 移动 机 器 人 Shakey 就 是 基于 慎 思 式 
体系 结构 来 控制 的 ， 它 利用 视觉 数据 进行 避 障 和 
导航 1。 


的 快速 性 和 推理 的 复杂 性 之 间 进 行 权衡 。 分 析 表 明 ， 
当 环 境 和 任务 可 以 由 先 验 知识 表示 时 ， 反 应 式 控制 器 
会 显示 出 强大 的 优越 性 ， 如 果 环 境 是 结构 化 的 ， 反 应 
式 控 制 器 能 够 在 处 理 特 定 问题 时 表现 出 最 佳 性 
能 3， 当面 对 环境 模型 、 记 忆 以 及 学 习 成 为 必 
需 的 问题 时 ， 反 应 式 控制 就 显得 无 法 胜任 了 。 


pu 
38.1.3 混合 式 一 思 行 合 一 


混合 式 控制 融合 了 反应 式 控制 和 慎 思 式 控制 的 优 
点 : 反应 式 的 实时 响应 与 慎 思 式 的 合理 性 和 最 优 性 。 


规划 模块 内 部 需要 一 个 关于 世界 的 符号 表示 模 
型 ， 这 能 够 让 机 器 人 展望 未 来 并 预测 出 不 同 状态 下 各 
种 可 能 动作 对 应 的 结果 ， 从 而 生成 规划 。 为 了 规划 的 
正确 性 ， 外 部 环境 的 世界 模型 必须 是 精确 和 最 新 的 。 
当 模 型 精确 且 有 足够 的 时 间 来 生成 一 个 规划 ， 这 种 方 
法 将 使 得 机 器 人 能 够 在 特定 环境 下 选择 最 佳 的 行动 路 
线 。 然 而 ， 由 于 机 器 人 实际 上 是 处 于 一 个 含有 噪声 ， 
并 且 动 态 变 化 的 环境 中 ， 上 述 情况 是 不 可 能 发 生 
Ag) 。 如 今 ， 没 有 一 个 情境 机 器 人 是 纯粹 慎 思 式 
的 。 为 实现 在 复杂 、 动 态 变 化 的 现实 环境 中 快速 做 出 
恰当 的 动作 ， 陆 续 有 学 者 提出 了 新 的 机 器 人 体系 
结构 。 


38.1.2 反应 式 一 不 想 ， 只 做 


反应 式 控制 是 一 种 将 传感器 输入 和 驱动 器 输出 二 
HUT ZR ALAR, HRW TE LO 


因此 ， 混 合式 控制 系统 包括 两 个 不 同 的 部 分 ， 反 应 
式 / 并 发 条 件 一 动作 规则 和 慎 思 式 部 分 。 反 应 式 和 慎 
思 式 二 者 必须 进行 交互 以 产生 一 个 一 致 输出， 这 是 一 
项 非常 具有 挑战 性 的 任务 。 这 是 因为 ， 反 应 式 部 分 处 
理 的 是 机 器 人 的 紧急 需求 ， 比 如 移动 过 程 中 避 开 障碍 
物 ， 该 操作 要 在 一 个 非常 快 的 时 间 尺 度 内 ， 直 接 利用 
外 部 感知 数据 和 信号 的 情况 下 完成 。 相 比 之 下 ， 慎 思 
式 部 分 利用 高 度 抽象 的 、 符 号 式 的 世界 内 在 表示 ， 需 
要 在 较 长 的 时 间 尺 度 上 进行 操作 ， 比 如 ， 执 行 全 局 路 
径 规 划 或 规划 高 层 决 策 方案 。 只 要 这 两 个 组 成 部 分 的 
输出 之 间 没 有 冲突 ， 该 系统 就 无 需 进一步 协调 。 然 
而 ， 如 果 和 欲 使 双方 彼此 收益 ， 则 该 系统 的 两 个 部 分 必 
须 进行 交互 。 因 此 ， 如 果 环 境 呈 现 出 的 是 一 些 突现 的 
和 即时 的 挑战 ， 反 应 式 系统 将 取代 慎 思 式 系统 。 类 似 
地 ， 为 了 引导 机 器 人 趋向 更 加 有 效 的 和 最 佳 的 轨迹 和 
目标 ， 慎 思 式 部 分 必须 提供 相关 信息 给 反应 式 部 分 。 


能 够 使 机 器 人 对 不 断 变化 和 非 结 构 化 的 环境 做 出 快速 
的 反应 站 。 反 应 式 控制 来 源 于 生物 学 的 刺激 一 响应 
概念 ， 它 不 要 求 获 得 世界 模型 或 对 其 进行 维护 ， 因 为 
它 不 依赖 于 慎 思 式 控制 中 各 种 复杂 的 推理 过 程 。 相 


这 两 部 分 的 交互 需要 一 个 中 间 组 件 ， 以 调节 使 用 这 两 
部 分 所 产生 的 不 同 表述 和 输出 之 间 的 冲突 。 这 个 中 间 
组 件 的 构造 是 混合 式 系 统 设 计 所 面临 的 最 大 挑战 。 

混合 式 系统 通常 采用 三 层 结构 ， 从 底 至 上 分 为 : 


反 ， 基 于 规则 的 机 器 人 控制 方法 不 仅 计算 量 小 ， 而 且 
无 需 内 部 表示 或 任何 关于 机 器 人 世界 的 知识 。 通 过 ; 
具有 最 小 内 部 状态 的 一 系列 并 发 条 件 一 动作 规则 
(例如 ， 如 果 碰 撞 ， 则 停止 ， 如 果 停 止 ， 就 返回 ) 进 
行 离线 编程 ， 并 将 其 舱 入 到 机 器 人 控制 絮 中 ， 反 应 式 
机 器 人 控制 系统 具有 快速 的 实时 响应 特性 SI, o 
获取 世界 模型 不 太 现 实时 ， 反 应 式 控制 就 特别 适用 于 
动态 和 非 结构 化 的 世界 。 此 外 ， 较 小 的 计算 量 使 得 反 
应 式 系 统 能 够 及 时 、 快 速 地 响应 变化 的 环境 。 

反应 式 控制 是 一 种 强大 而 有 效 的 方法 ， 它 广泛 地 
存在 于 自然 界 中 ， 如 数量 远 超 疹 椎 动物 的 昆虫 ， 它 们 
绝 大 多 数 均 是 基于 反应 式 控 制 的 。 然 而 ， 单 纯 的 反应 
式 控制 的 能 力 又 是 有 限 的， 因为 它 无 法 存储 信息 或 记 
TL, 或 者 对 世界 进行 内 在 的 表示 “" ， 因 此 ， 无 法 
随 着 时 间 的 流逝 进行 学 习 和 改进 。 反 应 式 控制 在 反应 


R 


反应 (执行 ) 层 、 中 间 (协调 ) 层 和 慎 思 (组 织 / 规 
Aj) 层 ， 其 中 位 于 最 底层 的 反应 层 具 有 最 高 的 控制 
精度 和 最 弱 的 智能 性 。 目 前 ， 已 经 有 学 者 针对 这 些 组 
件 的 设计 以 及 各 组 件 间 的 交互 进行 了 大 量 的 
Were. 

混合 式 系 统 的 三 层 结构 充分 利用 了 反应 式 控制 的 
动态 、 并 发 和 时 间 响 应 特性 以 及 慎 思 式 控 制 在 长 时 标 
上 全 局 有 效 动 作 的 优点 。 然 而 ， 关 于 这 些 组 件 之 间 的 
结合 方式 以 及 功能 分 割 等 问题 ， 至 今 还 没有 得 到 很 好 
解决 2 


38.1.4 基于 行为 的 控制 一 思考 行为 方式 


基于 行为 的 控制 采用 了 一 系列 分 布 的 、 交 互 的 
模块 ， 我 们 将 之 称 为 行为 ， 将 这 些 行为 组 织 起 来 以 
获得 期 望 的 系统 层 行为 。 对 于 一 个 外 部 观察 者 而 言 ， 
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行为 是 机 器 人 在 与 环境 交互 中 产生 的 活动 模式 ; 对 
于 一 个 设计 者 来 说 ， 行 为 即 是 控制 模块 ， 是 为 了 实 


用 一 个 规划 器 来 选择 行为 “2 ,“3T” 在 三 级 分 层 体 
系 结构 中 的 执行 层 采用 了 行为 。 这 两 种 设计 方案 都 根 


现 和 保持 一 个 目标 而 聚集 的 一 系列 约束 '*“”” 。 每 
个 行为 控制 器 接受 传感器 或 者 是 系统 中 行为 的 输入 ， 
并 提供 输出 到 机 器 人 的 驱动 器 或 者 到 其 他 行为 。 因 
此 ， 基 于 行为 的 控制 器 是 一 种 交互 式 的 行为 网 络 结 
构 ， 它 没有 集中 的 世界 表示 模型 或 控制 的 焦点 ， 相 
反 ， 个 人 行为 和 行为 网 络 保存 了 所 有 状态 的 信息 和 
模型 。 

通过 精心 设计 的 基于 行为 的 系统 能 够 充分 利用 行 
为 之 间 相 互 作用 的 动力 学 ， 以 及 行为 和 环境 之 间 的 动 
力学 。 基 于 行为 控制 系统 的 功能 可 以 说 是 在 这 些 交 互 
中 产生 的 ， 不 是 单独 来 自 于 机 器 人 或 者 扳 立 的 环境 ， 
而 是 它们 相互 作用 的 结果 尝 2 。 反 应 式 控制 可 以 利 
用 的 是 反应 式 规则 ， 它 们 仅 需 极 少 甚至 不 需要 任何 状 
态 或 表示 。 与 此 不 同 的 是 ， 基 于 行为 的 控制 方式 可 以 
利用 的 是 一 系列 行为 的 集合 。 此 处 的 行为 是 与 状态 紧 
密 相 连 的 ， 并 且 可 用 于 构造 表示 ， 从 而 能 够 进行 推 
理 、 规 划 和 学 习 。 
上 述 每 一 种 机 器 人 控制 方法 都 各 有 优 缺 点 ， 它 们 


据 可 用 的 世界 知识 的 推理 动态 地 重 构 了 行为 ”| 。 

机 器 人 控制 体现 了 关于 响应 的 时 间 斥 度 、 系 统 组 
织 和 模块 化 之 间 的 基本 权衡 : 只 有 当 具 有 充分 的 、 精 
确 的 、 最 新 的 信息 可 用 时 ， 慎 思 式 才能 通过 预测 来 避 
人 免 误 动作 ， 否 则 反应 式 可 能 是 应 对 世界 的 最 好 方式 。 
由 于 这 些 固有 的 权衡 ， 在 我 们 的 处 理 中 可 以 使 用 不 同 
的 方法 而 不 是 把 所 有 控制 需要 交 给 一 种 方法 是 很 重要 
的 。 选 择 一 个 适当 的 控制 方法 并 基于 它 进行 设计 最 大 
程度 取决 于 问题 的 属性 、 任 务 的 性 质 、 所 需 的 效率 与 
优化 级 别 ， 以 及 机 器 人 在 硬件 、 世 界 建 模 和 计算 方面 
的 能 力 。 


38.2 ”基于 行为 的 系统 的 基本 原理 


基于 行为 的 系统 的 基本 原理 可 以 简要 概括 如 下 : 

1) 类 似 于 控制 理论 中 的 控制 策略 ， 行 为 可 以 以 
软件 程序 或 硬件 元 件 的 形式 存在 。 

2) 每 个 行为 都 可 以 从 机 器 人 的 传感器 (例如 ， 


在 特定 的 机 器 人 控制 和 应 用 方面 都 扮演 着 非常 重要 
成 功 的 角色 ， 并 且 没 有 某 个 单一 的 方法 能 够 被 视 为 是 
理想 或 绝对 有 效 的 。 可 以 根据 特定 的 任务 、 环 境 以 及 
机 需 人 ， 来 选用 合适 的 机 器 人 控制 方法 。 

例如 ， 反 应 式 控制 是 环境 要 求 立即 响应 下 的 最 佳 
选择 ， 但 是 这 种 反应 速度 只 考虑 了 眼前 利益 ， 缺 乏 对 
过 去 的 回顾 和 对 未 来 的 展望 。 反 应 式 系统 在 高 度 随 机 
的 环境 中 也 是 一 种 非常 受 欢迎 的 选择 ， 通 过 对 环境 进 
行 恰当 的 描述 ， 从 而 可 在 一 个 反应 式 输入 一 输出 映射 
中 被 编码 。 另 一 方面 ， 在 需要 大 量 策略 和 优化 ， 以 及 
循环 搜索 和 规划 的 领域 ， 如 调度 、 游 戏 、 系 统 配 置 等 
问题 ， 慎 思 系 统 是 唯一 的 选择 。 混 合 系统 适用 于 需要 
内 部 建 模 和 规划 ， 并 且 对 实时 性 要 求 不 高 或 充分 独立 
于 高 层 推理 的 环境 和 任务 。 相 比 之 下 ， 基 于 行为 的 系 
统 最 适用 于 显著 动态 变化 的 环境 ， 此 时 追求 的 首要 目 
标 是 快速 响应 性 和 自 适应 性 。 另 外 ， 预 测 未 来 和 规避 


接近 传感器 、 距 离 探测 器 、 接 触 传 感 器 、 摄 像 机 ) 
和 /或 系统 的 其 他 模块 接收 输入 ， 并 向 机 器 人 的 执行 
ae (PM, 车 轮 、 机 械 手 扑 、 机 械 臂 、 语 言 装置 ) 
和 /或 系统 的 其 他 模块 输出 命令 。 

3) 多 个 不 同行 为 可 以 独立 地 从 相同 的 传感器 接 
收 输入 ， 并 向 相同 的 驱动 器 输出 命令 。 

4) 行为 的 编码 相对 简单 ， 并 可 以 递增 地 添加 进 
系统 中 。 

5) 为 提高 计算 速度 、 充 分 利用 行为 间 以 及 行为 
与 环境 间 的 交互 作用 , 行为 (或 它 的 子 集 ) 以 并 行 
形式 执行 。 

基于 行为 的 机 器 人 学 适 于 解决 情境 机 器 人 相关 问 
题 ， 允 许 它们 适应 真实 世界 环境 的 动力 学 ， 而 无 需 操 
作 于 真实 环境 的 抽象 表示 之 上 '“" ， 但 也 给 予 它们 
比 反 应 式 机 器 人 更 多 的 计算 能 力 和 表达 能 力 。 基 于 行 
为 的 系统 支持 感觉 和 动作 通过 行为 紧密 耦合 ， 并 使 用 


错误 动作 的 能 力也 是 必需 的 。 那 些 能 力 遍 布 于 主动 行 
为 ， 必 要 时 使 用 主动 表述 “” ， 正 如 本 章 稍 后 要 讨 
论 的 。 

基于 上 述 四 类 控制 机 制 来 设计 一 个 给 定 的 机 带 人 
的 计算 架构 ， 往 往 存 在 一 个 度 的 问题 。 基 于 行为 的 方 
法 具有 响应 快速 性 、 鲁 棒 性 和 灵活 性 的 优点 ， 而 知识 
的 抽象 表示 利于 进行 推理 、 规 划 *” 或 处 理 冲 突 目 


行为 结构 来 表示 和 学 习 。 因 此 ， 一 个 行为 常常 不 能 
赖 传统 的 世界 模型 执行 广泛 的 计算 或 推理 ， 除 非 这 样 
的 计算 能 够 及 时 完成 来 响应 动态 和 快速 变化 的 环境 和 
任务 需求 。 

行为 的 设计 在 各 种 抽象 层面 上 进行 ， 以 利于 进 
行 自 底 向 上 的 基于 行为 系统 的 构建 。 新 行为 递增 地 
加 入 到 系统 中 ， 从 简单 到 复杂 ， 直 到 它们 的 交互 使 


标 。 因 此 ， 在 进行 机 器 人 体系 结构 设计 的 时 候 ， 需 要 
考虑 如 何 融 合 不 同体 系 结构 的 优点 。 例 如 ，AuRA 使 


得 机 器 人 具有 所 期 望 的 全 面 能 力 。 通 常 , 行为 编码 
是 一 个 时 间 扩 展 过 程 ， 而 不 是 典型 反馈 控制 中 的 基 
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本 动作 (例如 ， 向 前 走 一 步 ， 转 一 个 小 角度 )。 作 
为 第 一 步 ， 生 存 行为 ， 例 如 避 碰 。 这 些 行 为 在 自然 
中 往往 是 反应 式 的 ， 原 因 是 反应 式 规则 可 以 形成 简 
单行 为 的 部 件 ， 并 且 往往 的 确 如 此 。 图 38. 1 展示 了 


激活 条 件 


感知 


低级 的 、 基 于 行为 的 系统 通用 部 件 。 注 意 ， 人 允许 行 
为 产生 动作 的 激活 条 件 ， 与 产生 动作 的 刺激 有 所 
区 别 。 


动作 选择 


图 38. 1 一 类 基于 行为 系统 的 总 体 框图 


接 下 来 ， 为 机 器 人 提供 更 多 复杂 能 力 的 行为 ， 例 
如 沿 墙 行走 、 追 逐 目标 、 归 梨 、 寻 找 物体 、 充 电 、 避 
光 、 人 合群、 拾 起 物体 、 寻 找 地 标 。 根 据 所 设计 的 系 
统 ， 可 以 加 入 使 用 分 布 式 表 述 的 行为 ， 如 能 够 学 习 世 
界 和 机 器 人 自身 的 行为 ， 以 及 在 那些 表述 和 学 习 到 的 
信息 上 进行 操作 。 表 示 和 学 习 的 更 多 细节 参见 
38.4 节 。 
时 间 和 空间 影响 的 交互 和 集成 在 基于 行为 的 系 
统 中 具有 关键 性 作用 。 仪 仅 使 用 一 个 以 预定 的 时 间 
间隔 控制 一 个 执行 器 的 过 程 ， 或 使 用 与 效应 器 个 数 
相同 的 过 程控 制 它们 ， 不 足以 作为 基于 行为 控制 的 
基础 。 时 间 上 并 行 的 过 程 与 直觉 和 内 部 状态 的 驱动 
的 组 合作 用 在 一 个 控制 系统 中 构成 了 相应 的 基于 行 
为 的 动态 学 。 

通过 开发 合适 的 属性 ， 受 益 于 交互 动力 学 的 丰富 
性 ， 基 于 行为 系统 的 典型 设计 使 得 行为 主要 在 环境 中 
的 交互 而 不 是 通过 系统 间 的 交互 。 由 于 这 些 动力 学 从 
交互 中 突现 出 来 而 不 是 在 内 部 由 机 器 人 的 程序 指定 ， 
这 些 动力 学 有 时 被 叫做 突现 行为 。 因 此 ， 一 个 基于 行 
为 的 系统 的 内 部 行为 结构 不 必 复 制 其 外 部 显 式 行为 。 
例如 ， 一 个 与 其 他 机 器 人 集群 的 机 器 人 可 以 没有 特定 
的 集群 行为 ， 取 而 代 之 的 是 通过 它 与 环境 和 其 他 机 器 
人 的 交互 导致 集群 ， 它 仪 有 的 行为 可 能 是 避 碰 、 跟 紧 
群体 和 继续 前 进 。 

为 了 使 上 述 方 法 有 效 ， 必 须要 解决 如 何 从 多 重 


选择 中 选择 特定 的 动作 或 行为 ， 也 就 是 已 知 的 动作 
选择 或 行为 协调 过 程 *”1。 这 是 基于 行为 系统 设计 
的 核心 挑战 之 一 。 一 种 动作 选择 方法 是 使 用 预定 义 
的 行为 等 级 ， 其 中 来 自 最 高 层 激活 行为 的 命令 才 被 
送 到 执行 器 ， 其 余 的 都 被 忽略 。 基 于 其 他 原理 的 许 
多 方法 以 及 用 于 动作 选择 问题 的 专用 方法 已 经 在 机 
器 人 系统 中 进行 了 研究 和 探讨 。 这 些 方法 的 目标 是 
为 了 提供 更 多 的 灵活 性 ， 但 是 在 有 些 情 况 下 ， 这 样 
做 的 代价 可 能 会 降低 效率 或 牺牲 最 终 控制 系统 的 可 
分 析 性 。 所 研究 的 方法 中 包括 了 各 种 运动 图 
式 呈 0、 命令 融合 呈 %1  、 通 过 行为 网 络 的 激活 传 
FROST) ， 以 及 模糊 逻辑 天 ?1 等。 关于 动作 选择 
机 制 的 综述 ， 参 见 参考 文献 [38.31]. 

由 于 基于 行为 的 系统 并 不 总 是 易于 描述 或 应 用 ， 
它们 也 经 常 被 误解 。 最 常见 的 一 种 误解 是 把 反应 式 
系统 与 行为 系统 等 同 起 来 。 历 史上 ， 基 于 行为 的 系 
统 的 出 现 受 到 反应 式 系统 的 启发 ， 并 且 两 者 都 支持 
感觉 与 动作 的 实时 耦合 天 ”2 ， 并 且 是 自 底 向 上 构 
造 和 发 展 起 来 的 ， 包 含 了 分 布 式 模块 。 然 而 ， 基 于 
行为 的 系统 本 质 上 比 反应 式 系统 更 强大 ， 因 为 它们 
REM THR) ， 而 反应 式 系统 则 不 能 。 反 应 式 
系统 受 限 于 缺乏 内 部 状态 ， 不 能 使 用 内 部 表述 和 学 
习 。 基 于 行为 的 系统 能 够 克服 这 个 局 限 ， 原 因 是 它 
们 具有 潜在 的 表达 单元 ,行为 能 够 以 分 布 式 的 方式 
存储 其 内 部 状态 。 
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在 基于 行为 的 系统 中 状态 和 表示 的 分 布 式 方式 是 
这 种 控制 方法 灵活 性 的 一 个 来 源 。 在 基于 行为 的 系统 
中 表示 是 分 布 式 的 ， 因 此 可 以 最 优 匹配 并 利用 导致 机 
器 人 行动 的 基本 行为 结构 。 于 是 思想 按照 与 动作 相同 
的 方式 组 织 。 因 此 如 果 一 个 机 器 人 需要 提前 规划 ， 它 
在 一 个 交流 行为 的 网 络 中 进行 ， 而 不 是 在 单独 的 、 集 
中 的 规划 器 中 进行 。 如 果 一 个 机 器 人 需要 存储 一 个 大 
地 图 ， 这 个 地 图 可 能 分 布 于 表达 其 组 件 的 多 个 行为 模 
块 中 ， 例 如 一 个 地 标 网 络 ， 如 参考 文献 [38.4] P; 
或 一 个 参数 化 导航 行为 网 络 ， 如 参考 文献 [38.35, 
36] 中 。 于 是 关于 地 图 /环境 /任务 的 推理 就 能 够 以 
一 种 主动 方式 ， 通 过 使 用 行为 网 络 内 部 的 信息 传递 来 
完成 。 基 于 行为 系统 的 规划 和 推理 组 件 采用 与 感知 和 
面向 动作 相同 的 机 制 ， 因 此 它们 之 间 的 操作 并 不 是 在 
完全 不 同 的 时 间 尺 度 和 表示 上 进行 。 在 行为 网 络 内 部 
使 用 了 各 种 不 同形 式 的 分 布 式 表 示 ， 范 围 从 静态 列表 
结构 和 网 络 直到 动态 程序 过 程 。 

另 一 个 通常 被 误解 的 部 分 是 关于 基于 行为 的 系统 
和 混合 系统 的 比较 。 因 为 这 两 者 使 用 不 同 的 模块 化 策 
略 ， 往 往 假 设 一 个 方法 (通常 是 混合 ) 已 经 改进 了 


3) 行为 无 中 心 部 件 ， 每 个 模块 只 对 自 
下 一 节 将 详细 描述 如 何 将 基于 行为 的 基本 原型 
于 机 器 人 控制 。 


HH o 


用 


| 


38.3 基础 行为 


行为 合成 是 指 为 机 器 人 设计 一 个 行为 集合 的 过 
程 ， 虽 然 有 些 自动 合成 行为 的 方法 已 被 开发 并 成 功 展 
示 ， 但 行为 合成 通常 还 是 由 人 工 完成 一 ? ”1 。 在 所 
有 情况 下 ， 行 为 执行 特定 活动 是 为 达到 一 个 目标 ， 或 
维持 某 种 状态 。 虽 然 人 们 已 经 考虑 到 为 给 定 的 机 器 人 
或 任务 定义 最 优 行为 集合 ， 但 这 样 一 个 概念 是 不 现实 
的 ， 因 为 在 给 定 系统 和 环境 中 ， 所 依赖 的 太 多 细节 问 
题目 前 还 不 能 得 到 有 效 形式 化 。 

Matart 等 W* 中 描述 的 基础 行为 ， 亦 可 称 为 原始 
行为 ， 作 为 构造 的 一 种 工具 简化 了 行为 合成 技术 。 基 
础 行为 是 指 这 样 的 一 组 行为 集合 ， 其 中 的 每 一 个 行为 
都 是 必要 的 ， 也 就 是 说 每 个 行为 要 么 实现 ， 要 么 帮助 
实现 相关 任务 ， 如 果 缺 少 了 该 行为 ， 则 该 组 的 其 他 行 
为 就 不 能 实现 这 个 任务 。 此 外 ， 基 础 行为 集 要 充分 胜 


表达 能 力 。 事 实 上 ， 基 于 行为 的 系统 和 混合 系统 具有 
相同 的 表达 和 计算 能 力 : 都 能 开发 表达 和 预测 ， 但 它 
们 以 不 同 的 方式 进行 。 这 导致 基于 行为 系统 与 混合 系 
统 具 有 不 同 的 适用 领域 。 特 别 地 ， 混 合 系统 垄断 单机 
天 人 控制 领域 ,除非 任务 实时 性 要 求 高 到 必须 使 用 反 
应 式 系统 。 基 于 行为 的 系统 垄断 多 机 器 人 控制 的 领 
域 , 原因 是 系统 内 部 行为 集群 的 概念 更 加 贴 合 机 器 人 
集群 ， 使 其 具有 重 棒 性 ， 适 应 群体 行为 ”1。 更 
多 细节 参见 第 40 章 “ 多 机 器 人 系统 ”。 

与 混合 系统 一 样 ， 基 于 行为 的 系统 可 以 分 层 组 
织 , 但 与 混合 系统 不 同 的 是 ， 这 里 的 层次 在 时 间 尺 度 
和 所 使 用 的 表示 方面 并 没有 很 大 的 分 别 。 基 于 行为 的 
系统 通常 不 使 用 混合 方法 ， 而 是 采用 常用 的 分 层 / 顺 


任 控制 器 所 规定 的 任务 。 选 择 基础 这 个 词 是 为 表现 出 
线性 代数 中 的 类 似 概 念 指示 ， 如 简约 性 和 必要 性 类 似 
于 线性 独立 的 思想 ， 自 给 自足 的 想法 类 似 于 线性 代数 
中 生成 的 概念 。 基 础 行为 应 该 是 简单 、 稳 定 、 重 棒 和 
可 扩展 的 。 

男 一 种 基础 行为 的 组 织 原 则 是 正 交 性 。 如 果 两 个 
行为 之 间 不 存在 相互 干扰 ， 而 其 对 其 他 行为 也 无 副 作 
用 ， 则 这 两 个 行为 是 正 交 的 。 正 交 性 的 获得 是 行为 采 
取 互 相 排斥 的 传感器 输入 ， 另 一 种 方法 是 使 不 同 的 行 
为 控制 不 同 的 驱动 器 。 当 机 器 人 的 动力 学 不 妨碍 它们 
的 可 分 性 时 ， 这 种 分 解 形式 是 唯一 可 行 的 形式 。 自 主 
直升机 控制 是 一 个 高 度 耦 合 系统 的 例子 ， 相反，Sari- 
palli 等 演示 了 基于 行为 的 控制 如 何 有 效 地 应 用 


序 划分 。 基 于 行为 的 系统 同时 提供 底层 控制 和 高 层 思 
考 。 后 者 可 以 由 一 个 或 多 个 在 其 他 行为 或 模块 上 计算 
的 分 布 表 达 执 行 ， 常 常 直接 应 用 于 底层 行为 和 它们 的 
输出 。 最 终 系统 自 底 向 上 建立 ， 不 是 以 不 同 的 表达 和 
独立 部 件 区 分 而 是 由 直接 以 某 种 方式 拥 绑 到 行为 的 元 
素 组 成 。 基 于 行为 的 系统 的 强大 功能 和 复杂 性 均 取决 
于 各 组 件 行为 的 设计 、 协 调和 使 用 的 方式 。 
简要 概括 基于 行为 的 系统 : 

1) 以 行为 作为 制订 决策 和 执行 动作 的 组 块 。 

2) 在 行为 上 使 用 分 布 式 并 行 评价 和 并 行 控 制 ， 
从 传感器 数据 获得 实时 输入 并 向 执行 器 产生 实时 


命令 。 


于 和 鲁 棒 自主 直升机 飞行 。 
基础 行为 设计 原则 已 应 用 到 单个 机 器 人 和 多 机 咒 
人 基于 行为 系统 ， 应 用 范围 包括 导航 、 竟 食 、 协 调 小 
组 运动 、 推 箱 等 。 


38.4 基于 行为 系统 中 的 表示 法 


在 将 表示 法 藤 入 到 基于 行为 系统 中 时 ， 面 临 着 在 
系统 各 级 决策 上 如 何 保存 所 使 用 方法 的 基本 原则 的 挑 
战 ,行为 与 抽象 推理 过 程 相 结合 在 某 种 程度 上 必须 利 
用 交互 式 动力 学 和 理想 应 急 系 统 。 

Matarie 等 ”3.3 通过 一 个 名 为 Toto 的 机 器 人 来 
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开展 研究 工作 ， 其 中 Toto 将 分 布 式 表示 法 引入 到 基 
于 行为 系统 中 。 在 基于 行为 的 框架 中 ，Toto 的 功能 
括 安 全 导航 、 地 标 检 测 、 地 图 学 习 ， 以 及 在 已 学 习 地 
图 中 的 路 径 规划 。 为 了 利用 基本 的 行为 控制 原则 ， 
Toto 的 表示 法 不 是 使 用 个 集中 地 图 ， 而 是 将 环境 中 
任何 新 发 现 的 地 标 都 分 配 到 一 个 新 的 地 图 描述 行为 
中 ， 并 存储 到 地 标 描述 器 ( 它 包 括 地 标的 类 型 ,第 
卡 儿 位 置 估计 和 罗盘 定位 )。 当 感知 输入 与 地 标 描述 
相 匹 配 时 ， 机 器 人 就 会 定位 于 特定 的 地 标 ， 该 行为 就 
会 被 激活 。 下 面 是 每 个 地 标 行为 的 伪 代 码 : 
算法 38.1 
my-behavior-type:C 


my- compass- direction :0 

my- approximate- location: (x,y) 

my- approximate- length :6. 5 

任意 时 刻 收 到 的 (input) 

如 果 input( behavior-type) = my- behavior- type 
且 


input( compass- direction) = my- compass- direction 


pu 


active < - true 


随 着 新 地 标的 发 现 ， 它 们 被 添加 到 地 图 描述 行 
为 网 络 中 。 这 样 ， 由 此 产生 的 地 图 网 络 拓 扑 图 同 构 
F Toto 在 物理 环境 中 探索 的 网 络 图 。 网 络 图 的 边 也 
与 行为 网 络 通信 相关 ， 人 允许 地 标 行为 通过 本 地 信息 
传递 进行 交互 。 因 此 ， 目 前 活跃 的 地 图 行为 可 以 将 
消息 发 送 到 它 的 拓扑 近邻 ， 从 而 表明 它 将 期 望 成 为 
下 一 个 被 识别 的 路 标 ， 以 帮助 Toto 来 定位 。 同 样 ， 
网 络 规划 也 是 通过 使 用 相同 的 消息 传递 机 制 来 进行 
的 。 目 标 地 标 〈 可 以 由 用 户 选 择 作为 任务 的 一 部 
分 ， 如 去 某 个 走廊 ,或 到 就 近 朝 北 的 墙 )， 发 送信 
息 ( 即 激活 的 传递 ) 到 其 邻居 ， 然 后 传递 到 整个 网 
络 。 信 息 传 递 的 同时 ， 累 计 图 中 每 个 地 标的 长 度 ， 
从 而 估算 每 个 路 径 的 长 度 。 当 前 活跃 的 网 络 行为 的 
最 短路 径 表 明 朝 着 目标 的 最 佳 方向 ， 这 相当 于 一 个 
分 布 式 的 Dijkstra 搜索 。 重 要 的 是 ， 这 个 搜索 不 是 一 
个 集中 地 图 表示 法 中 的 静态 过 程 ， 而 是 一 个 行为 地 
图 中 的 在 线 动态 过 程 。 如 果 机 器 人 是 被 放置 到 另 一 
个 位 置 ， 只 要 它 定 位 ， 它 将 一 直 朝 向 目标 的 最 优 路 
径 ; 每 一 个 地 标 对 趋向 目标 的 下 一 个 动作 做 出 一 个 
局 部 决策 ， 并 没有 唯一 的 全 局 路 径 存储 在 任何 中 枢 
位 置 /表示 法 。 因 此 ， 路 径 是 不 断 刷新 和 更 新 的 ， 如 
果 有 任何 通道 被 阻塞， 则 图 中 的 边 就 会 断 开 ， 并且 
动态 更 新 最 短路 径 。 


Toto 充分 体现 了 在 基于 行为 系统 中 ， 表 示 法 是 可 
以 以 分 布 式 的 方式 被 储存 的 ， 使 机 器 人 能 够 最 佳 地 匹 
配 当前 的 行为 结构 ， 产 生 外 部 目标 驱动 的 活动 。 如 果 
机 需 人 需要 做 出 一 个 高 层次 的 决策 〈 如 规划 到 达 一 
个 遥远 的 目标 ) ， 它 要 在 通信 行为 的 网 络 中 实现 ， 而 
不 是 靠 单 一 的 集中 组 件 。 这 使 得 系统 中 可 扩展 的 和 高 
效率 的 计算 结果 看 做 一 个 整体 ， 因 为 决策 过 程 通常 较 
慢 ， 如 规划 是 分 布 式 和 模块 化 的 ， 这 样 在 某 种 程度 上 
使 它们 与 时 间 标 度 和 系统 其 他 的 表示 法 更 一 致 。 我 们 
注意 到 基于 行为 系统 与 混合 动力 系统 有 重大 区 别 ， 基 
于 行为 系统 使 用 行为 作为 通用 模块 来 同化 表示 法 ， 而 
混合 系统 本 质 上 在 系统 的 不 同 层次 依赖 不 同 的 表示 法 
和 时 间 标 度 。 


基于 行为 系统 中 的 学 习 


38.5 


在 动态 环境 中 改善 实时 性 能 以 适应 周围 环境 ， 是 
情境 机 器 人 的 重点 研究 内 容 。 传 统 的 机 器 学 习 通 常 花 
费 很 长 的 时 间 来 优化 其 性 能 ， 与 传统 机 器 学 习 不 同 ， 
情境 学 习 目 标 是 能 够 较 快 地 适应 不 确定 的 环境 。 从 生 
物 学 模型 的 角度 看 ， 通 常 认为 给 定 学 习 的 特性 直接 来 
自 环 境 反馈 。 机 器 学 习 尤 其 是 强化 学 习 ， 所 具有 的 处 
理 可 变 环境 的 适应 性 ,已 经 被 成 功 地 应 用 于 行为 机 带 
A, PNAS A BeOS! 、 导 航 和 创建 拓 
扑 图 '*3%1、 任 务 分 解 半 91、 社会 行为 六 下 以 及 
在 机 器 人 足球 赛 中 辨别 对 手 和 球门 拉 2  。 人 工 生命 
的 方法 ， 如 进化 计算 /遗传 算法 、 模 糊 逻 辑 、 视 觉 学 
习 、 多 智能 体系 统 ， 还 有 许多 其 他 研究 方向 已 经 在 动 
物 模型 和 实际 应 用 中 得 到 不 断 发 展 ， 同 样 这 些 方法 也 
会 被 进一步 研究 和 探索 并 应 用 到 基于 行为 机 器 人 研 
究 中 。 

当 自 主机 器 人 在 不 可 预知 和 部 分 可 见 的 环境 中 行 
进 时 ， 必 须 检 查 周围 环境 的 变化 ， 在 与 周围 环境 的 动 
态 交 互 中 捕捉 可 能 发 生 的 情况 ， 并 把 观察 到 的 各 种 信 
息 进 行 快 速 的 整合 ， 这 是 自主 机 器 人 一 个 非常 重要 的 
867; 05057 | FE zs Bc UOS 中 的 研究 显示 ， 目 
标 管理 的 规划 和 反应 两 者 之 间 的 平衡 可 以 由 不 同 因 素 
激活 或 抑制 内 部 变量 来 完成 3” 。 刺 激 因素 可 以 
是 循环 的 〈 例 如 昼夜 规律 ) ， 也 可 以 是 以 不 同 的 时 间 
依赖 方式 来 变化 的 。 总 之 ， 激 励 系统 的 目的 就 是 为 了 
使 机 器 人 在 适应 环境 和 完成 任务 之 间 有 效 地 达到 
平衡 。 

在 下 面 的 部 分 ， 我们 将 讨论 三 种 已 被 成 功 验证 了 
的 基于 行为 系统 的 学 习 方 法 : 

1) 强化 学 习 。 
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2) 学 习 行 为 网 络 。 

3) 从 历史 行为 中 学 习 。 

方法 的 不 同 之 处 是 在 学 习 了 什么 和 算法 在 哪里 得 
到 应 用 ,但 在 所 有 的 情况 下 ， 行 为 学 习 都 是 学 习 过 程 
的 基础 。 


38. 5.1 强化 学 习 


众所周知 ， 强 化 学 习 (Reinforcement Learning, 
RL) 存在 维 数 灾难 问题 ， 而 行为 被 认为 可 以 用 来 加 
速 强化 学 习 。 基 于 行为 系统 最 早 的 强化 学 习 例子 是 六 
Jg Ib BOR C 和 推 箱 子 问题 ”1 。 两 者 都 是 将 控 
制 系统 分 解 为 一 些小 的 行为 集合 ， 并 使 用 泛 化 的 输入 
状态 ， 从 而 有 效 地 减 小 状态 空间 。 在 推 箱子 问题 中 ， 
学 习 被 分 解 成 许多 模块 化 策略 ， 以 此 来 相互 学 习 单 独 
行为 : 当 箱子 被 卡 住 时 退出 ， 当 丢失 箱子 并 且 没有 被 
卡 住 时 寻找 箱子 ， 当 接触 到 一 个 箱子 并 且 没 有 被 卡 住 
时 推 箱子 。 模 块 化 行为 使 得 学 习 速 度 加 快 ， 并 且 学 习 
和 鲁 棒 性 更 好 。 

参考 文献 [38.23] 和 [38.61] 研究 了 如 何 将 
强化 学 习 扩 展 到 多 机 器 人 的 基于 行为 系统 。 在 多 机 器 
人 系统 中 ， 由 于 其 他 智能 体 和 并 发 学 习 器 的 存在 ， 环 
境 对 非 稳 定性 和 可 信 度 赋值 提出 进一步 挑战 。 此 问题 
是 在 四 个 机 器 人 吏 食 任务 的 背景 下 研究 的 ， 每 个 机 器 
人 初步 具备 一 个 小 的 基础 行为 集合 (搜索 、 归 中、 
采摘 、 放 下 、 跟 随 、 避 免 ) ， 并 且 能 学 习 个 体 行为 选 
择 策略 等 ， 行 为 选择 策略 决定 了 在 何 种 情况 下 执行 何 
种 动作 。 由 于 并 发 学 习 带 之 间 的 相互 干扰 ， 该 问题 不 
能 直接 通过 标准 的 强化 学 习 来 解决 。 这 时 一 个 心理 学 
的 概念 一 一 塑造 被 引入 ， 随 后 应 用 到 机 器 人 强 
化 学 习 中 1。 塑造 推动 回报 更 接近 行为 的 子 目 标 ， 
从 而 鼓励 学 习 顺 通过 更 有 效 地 搜索 行为 空间 来 逐步 改 
善 它 的 行为 。Matarie*% 通过 进度 估计 引入 塑造 ， 
用 来 衡量 执行 过 程 中 进度 朝向 一 个 特定 的 行为 目标 进 
展 。 这 种 塑造 回报 的 形式 针对 延迟 回报 有 两 个 问题 : 
行为 终止 和 偶然 回报 。 终 止 行为 是 由 事件 驱动 的 ; 任 
何 给 定 行为 的 持续 时 间 取 决 于 与 环境 的 动态 交互 作 
用 ,并 且 可 以 相差 很 大 。 进 度 估计 提供 了 一 个 原则 来 
定义 什么 时 候 行为 可 以 被 终止 ， 即 使 任务 没有 完成 并 
且 外 部 产生 的 事件 也 没有 发 生 。 侦 然 的 奖励 是 指 奖 励 
归 因 于 特定 情况 一 行为 (状态 一 动作 ) 对 ， 人 情况 一 
行为 对 实际 上 是 以 前 行动 或 动作 的 结果 。 它 表现 如 
FF: 以 前 的 行为 使 得 系统 更 接近 目标 , 但 有 些 事件 会 
引起 行为 转换 ， 并且 随 后 目标 的 实现 更 归功 于 最 后 的 
行为 ， 而 不 是 以 前 的 行为 。 进 度 估计 形式 的 塑造 回报 
有 效 地 消除 了 这 种 影响 ， 因 为 它 提供 了 执行 过 程 中 的 


反馈 行为 ， 更 好 地 奖励 以 前 有 用 的 行为 ， 从 而 更 妥善 
地 分 配 信用 度 。 

总 之 ， 强 化 学 习 已 被 成 功 地 应 用 于 基于 行为 的 机 
器 人 技术 中 ， 特 别 是 在 行为 选择 层面 。 行 为 结构 促进 
了 学 习 过 程 ， 并 且 提 供 了 高 水 平 的 行为 表示 法 和 时 间 
扩展 动力 学 。 


38.5.2 ”学习 行 为 网 络 


基于 行为 系统 的 模块 化 与 行为 网 络 一 样 允 许 应 用 
在 网 络 水 平 。Nicolescu 等 (353.3 拓展 了 抽象 行为 的 概 
念 ， 抽 象 行为 将 一 个 行为 的 激活 条 件 从 其 输出 动作 中 
(也 就 是 所 谓 的 原始 行为 ， 与 38. 3 节 描 述 的 基础 行为 
具有 相同 的 原则 ) 分 离 ， 这 允许 对 与 原始 行为 有 关 
的 激活 条 件 进行 更 一 般 的 设置 。 虽 然 这 对 于 任何 单一 
任务 不 是 必需 的 ,但 它 给 表示 法 提供 了 一 般 性 。 一 个 
象 的 行为 是 某 一 给 定 行为 激活 条 件 (先决 条 件 ) 
和 结果 (后 置 条 件 ) 的 组 合 ; 结果 与 经 典 的 慎 思 式 
系统 类 似 ， 也 是 一 个 抽象 的 一 般 操作 (LE 38.2)。 
原始 的 行为 ， 通 常 是 由 一 些小 的 基础 集合 组 成 ， 可 能 
涉及 一 个 或 一 个 完整 的 序 贯 或 并 发 执行 的 行为 的 


集合 。 

A 一 激活 输出 /输入 抽象 行为 
Pp 一 前 提 输 入 2 N 

二 抑制 输入 , K m 
E 一 有 效 输出 : WO 


图 38.2 行为 网 络 


这 种 行为 网 络 通过 结合 抽象 表示 法 和 基于 行为 网 
络 两 者 的 优点 ， 来 指定 策略 或 者 总 体 规划 。 网 络 的 节 
点 表示 抽象 的 行为 ， 节 点 之 间 的 连 线 代 表 前 提 和 后 置 
条 件 依赖 ， 该 任务 规划 和 策略 表示 为 这 些 行为 的 一 个 
网 络 。 在 任何 基于 行为 的 系统 中 ， 当 一 个 行为 的 条 件 
得 到 满足 时 ， 该 行为 就 被 激活 。 类 似 地 ， 当 一 个 抽象 
行为 的 条 件 被 满足 时 ， 则 该 行为 激活 一 个 或 多 个 原始 
行为 以 获得 在 其 后 置 条 件 中 指定 的 效果 。 网 络 拓扑 结 
构 在 抽象 行为 层 对 任意 特定 任务 的 行为 序列 进行 编 
人 码 ， 这 样 ， 由 于 抽象 行为 网 络 的 计算 量 较 小 ， 对 多 任 
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务 的 求解 可 以 在 单一 系统 内 部 进行 编码 并 进行 动态 
切换 。 

Nicolescu 等 中 5 介绍 了 一 种 在 离线 状态 或 运 
行 时 的 网 络 自动 生成 方法 。 后 者 能 够 使 一 个 学 习 机 
器 人 动态 地 获取 任务 描述 ， 同 时 观察 它 的 环境 ， 其 
中 包括 其 他 机 器 人 或 示 教 者 。 该 方法 在 移动 机 器 人 
身上 得 到 了 验证 ， 它 是 通过 一 个 人 以 及 通过 观察 自 
身 的 抽象 行为 的 前 置 和 后 置 条 件 激活 的 人 类 展示 任 
务 的 表示 法 ， 从 而 形成 新 的 抽象 行为 网 络 来 表现 展 
示 任 务 '*“%。 该 机 器 人 能 够 获得 新 的 行为 序列 和 组 
合 ( 即 同时 执行 行为 )， 成 功 地 完成 各 项 学 习 任 务 ， 
包括 按照 特定 的 顺序 访问 各 项 目标 、 拾 到、 运输 和 
搬运 物体 ， 进 行 障碍 人 处理 ， 并 以 特定 的 方式 操纵 避 
障 路 线 。 


38.5.3 ”从 历史 行为 中 学 习 


大 多 数 的 慎 思 式 方法 是 来 自 对 传感器 的 输入 和 机 
器 人 采取 的 行动 推理 中 获得 知识 。 这 将 使 得 机 器 人 世 
界 具 有 复杂 的 状态 空间 表示 ， 以 及 没有 考虑 到 这 些 感 
觉 /采取 的 行动 所 处 的 环境 。 正 如 已 经 讨论 过 的 , 行 
为 已 经 迅速 地 被 用 作 低 级 别 的 控制 模块 ， 这 些 模块 是 
由 与 环境 交互 的 经 验 来 驱动 的 。 行 为 也 可 以 作为 对 那 
些 交互 进行 建 模 的 一 种 抽象 表示 。 有 一 种 方法 是 利用 
历史 信息 1， 即 明确 地 考虑 观测 到 的 时 间 序 列 ， 
以 便 做 出 决定 。 将 这 一 理念 运用 到 基于 行为 的 系统 
中 ， 通 过 了 解 每 一 个 行为 的 目的 和 观察 它们 的 使 用 历 
史 ， 机 器 人 可 以 根据 在 其 运行 环境 中 的 经 历来 推理 及 
建立 它 的 意图 。 这 里 也 利用 了 抽象 行为 的 概念 来 激活 
行为 ， 并 作为 学 习 内 容 的 表示 。 

学 习 先 验 知识 中 ， 可 以 使 基于 行为 的 系统 在 不 确 
定 区 域 以 及 多 个 机 器 人 同时 学 习 的 动态 变化 的 环境 
中 ， 改 变 机 器 人 的 行为 搜索 策略 ， 进 而 去 搜索 有 颜色 
的 目标 (模块) ONS 。 在 搜索 任务 中 ， 机 器 人 有 两 
个 任务 : 寻找 一 个 目标 〈 搜 索 任 务 ) ， 并 返回 到 起 始 
A (VASES ) 。 通 过 设 定 机 器 人 行为 来 完成 这 些 任 
务 : 一 是 寻找 模块 的 行为 ， 称 为 模块 寻找 ， 二 是 归 巢 
行为 ,返回 起 始点 并 放下 木 块 。 速 度 控制 行为 在 机 器 
人 移动 的 过 程 中 也 被 用 于 执行 上 述 两 个 任务 ， 所 有 这 
些 行为 称 为 任务 行为 。 基 于 机 器 人 前 方 的 木 块 存在 与 
否 以 及 与 起 始点 的 接近 程度 ， 通 过 预先 编程 来 确定 激 
活 任务 行为 的 条 件 。 

机 器 人 也 需要 在 环境 中 安全 导航 。 在 这 种 方法 
中 ， 除 非 机 器 人 离 梨 很 近 并 且 携 带 模 块 ， 避 障 行为 才 


m 


利 情况 或 干扰 ， 被 称 为 维护 行为 。 设 计 者 决定 在 什么 
情况 下 启动 维护 行为 ， 但 不 能 确定 它们 何 时 在 任务 中 
发 生 ， 因 为 这 和 机 器 人 与 它 所 处 环境 之 间 相 互 作 用 的 
动态 性 是 息息相关 的 。 

机 器 人 学 习 使 用 替代 行为 (跟随 、 静 止 、 随 机 
转向 ) ， 在 它 的 行动 指令 中 引入 变化 ， 从 而 改变 其 
完成 任务 的 方法 。 相 对 于 其 他 类 型 的 行为 ， 蔡 代行 
为 没有 一 个 先 验 的 激活 条 件 ， 其 目的 是 让 机 器 人 根 
据 以 往 的 经 验 学 会 何 时 激活 这 些 行为 ， 当 它 在 完成 
任务 中 受到 干扰 时 。 图 38. 3 说 明了 行为 是 如 何 优 先 
使 用 固定 的 抑制 机 制 的 ， 与 参考 文献 [38.9] 包含 
的 体系 结构 相似 ， 但 在 激活 行为 上 有 所 不 同 ， 即 允 
许 发 出 输出 和 动态 变化 。 根 据 行为 准则 ， 一 个 激活 
行为 是 否 会 被 用 来 控制 机 器 人 人， 取决 于 检测 到 的 感 
知 条 件 和 判别 机 制 。 一 个 激活 行为 只 有 在 它 为 机 器 
人 提供 实际 的 控制 命令 时 才 被 使 用 。 每 当 一 个 行为 
被 合用， 其 相应 的 符号 被 发 送 到 交互 模型 ， 生 成 行 
为 序列 ， 然 后 随 着 时 间 的 推移 使 用 。 每 个 任务 都 用 
到 独立 学 习 树 ， 具 体 使 用 哪 一 棵 树 是 根据 激活 任务 
的 行为 来 确定 的 。 


行为 序列 
..FFFAAAAAASSSSY YY YYHHH...SSSSAAAA į 


行为 历史 的 树 表示 


可 选 行为 的 激活 


图 38.3 行为 层 与 交互 模型 层 的 组 织 形式 ( 阴影 部 分 

的 行为 表示 搜索 任务 中 激活 行为 的 一 个 例子 ， 以 随机 

周转 进行 选择 的 替代 行为 。 为 清楚 起 见 ， 没 有 画 出 感 
知 输入 部 分 ) 


该 算法 使 用 树 结构 来 存储 行为 使 用 的 历史 。 如 图 
38.3 的 上 部 分 所 示 ， 一 棵 典型 的 树 的 节点 用 来 储存 


被 激活 ， 除 此 之 外 将 被 禁用 ， 以 使 机 器 人 接近 巢 的 区 
域 。 这 种 类 型 的 行为 ， 在 执行 任务 中 通常 用 来 处 理 不 


在 完成 任务 当中 用 来 控制 机 如 人 的 行为 (H 用 来 归 
HAYKIR), n 表示 节点 本 身 和 其 继任 者 之 间 的 传递 
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次 数 (如 从 行为 使 用 观察 得 到 )。 最 初 ， 一 个 特定 的 
任务 树 是 空 的 ， 它 随 着 机 器 人 获取 任务 逐步 构建 起 
来 。 叶 子 节点 标记 为 (为 最 终 节点 ) ， 用 来 存储 特 
定 树 路 径 的 整体 性 能 。 每 当 路 径 是 完全 重复 的 ， 且 使 
用 的 行为 是 同一 顺序 时 ,节点 上 将 更 新 为 存储 性 能 
与 近期 试验 中 当前 性 能 的 平均 值 。 

学 习 是 通过 加 强 实现 的 。 根 据 不 同 的 领域 和 任 
务 ， 可 以 用 多 种 指标 来 评估 其 性 能 ， 而 且 在 这 种 学 
习 算 法 中 可 以 使 用 不 同 的 指标 。 我 们 可 以 通过 对 行 
为 使 用 的 观察 来 看 到 自我 评估 的 概念 有 多 深 并 进行 
学 习 ， 这 里 所 用 的 评估 函数 并 不 是 基于 环境 或 是 任 
务 的 特征 来 建立 的 。 相 反 ， 它 是 基于 行为 所 使 用 的 
时 间 。 将 与 任务 相关 的 行为 所 用 的 时 间 同 维护 行为 
的 开发 所 用 时 间 之 间 的 比较 来 作为 评估 标准 。 因 此 ， 
行为 选择 策略 是 由 机 器 人 在 它 所 处 的 环境 中 可 以 学 
到 什么 经 验 决定 的 ， 而 不 必得 到 环境 中 的 最 佳 操 作 
条 件 的 先 验 特征 。 

通过 利用 树 和 评估 函数 ， 该 算法 有 两 个 使 用 维护 
行为 的 选择 : 

1) 对 激活 行为 不 作 任何 改变 (观察 选择 ) 。 

2) 激活 一 个 替代 行为 。 

树 的 路 径 节 点 序列 刻画 了 机 器 人 究竟 经 历 了 怎样 
的 相互 作用 。 可 以 用 不 同 的 选择 标准 来 对 当前 树 所 处 
状态 的 性 能 与 期 望 性 能 进行 比较 ， 接 着 进行 研究 
(学 习 蔡 代行 为 的 影响 ) ， 然 后 开发 〈 去 发 掘 在 过 去 
的 研究 中 学 习 到 了 什么 ) 策略 。 对 于 给 定 节点 的 期 
望 性 能 是 由 子路 径 上 的 最 终 节 点 所 存储 的 性 能 的 总 
和 ， 再 乘 以 树 中 与 当前 位 置 相 关 的 子路 径 的 使 用 频率 
得 到 的 。 最 后 ， 由 于 该 算法 是 用 于 哮 杂 和 非 平稳 条 件 
下 ， 因 此 需要 使 用 删除 路 径 来 保持 交互 模型 的 更 新 。 
这 通过 保留 一 定数 目 最 近 树 中 使 用 最 多 的 路 径 来 
实现 。 

这 种 方法 所 得 到 的 结果 表明 ， 该 机 器 人 能 够 学 习 
预料 之 外 的 策略 ( 如 在 一 个 静态 的 障碍 前 停止 ， 以 
增加 转弯 角度 及 进行 目标 定位 ) ， 以 及 原始 策略 ( 如 
当 靠近 其 他 机 絮 人 或 在 围栏 拥挤 时 沿 墙 壁 行走 )。 总 
的 来 说 ， 培 养 这 种 能 力 是 相当 重要 的 ， 因 为 它 使 得 机 
器 人 在 不 稳定 环境 下 进行 学 习 成 为 可 能 ， 这 才 是 他 们 
运行 的 真正 现实 环境 。 
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38.6 后续 工作 


基于 行为 的 机 器 人 已 经 能 实现 各 种 常规 的 功能 ， 
如 避 障 、 导 航 、 地 形 匹 配 、 跟 踪 、 追 寻 、 物 体操 作 、 
任务 分 工 与 合作 ， 以 及 学 习 映 射 、 导 航 和 行走 。 它 们 


同时 也 展示 了 一 些 新 颖 的 应 


d, WEBER, ME, 


足球 比赛 、 人 机 交互 、 模 仿 昆 虫 甚至 是 人 的 行为 等 大 


规模 的 群体 行为 中 sm 。 基 于 


行为 方法 应 用 在 移动 


机 器 人 、 水 下 机 器 人 、 太 空 探 索 机 器 人 、 交 互 式 社会 


机 器 人 和 那些 具有 抓 


B. RE, 


行走 、 奔 跑 以 及 其 他 


功能 的 机 器 人 一 样 ,广泛 存在 于 消费 市 场 ， 如 iRobot 
公司 生产 的 用 来 吸 尘 的 Roomba 机 器 人 路 ， 它 就 是 


应 用 基于 行为 控制 的 典型 事例 ， 
的 实用 性 。 


结果 显示 其 具有 广泛 


在 机 器 人 控制 中 基于 行为 结构 的 使 用 已 经 从 单 系 
统 实施 发 展 到 组 合 学 习 形式 、 状 态 估计 和 分 布 式 计算 
的 方式 上 。 对 于 移动 机 器 人 的 内 部 导航 ?20m7 ， 


行为 被 合并 到 一 个 模糊 推理 系统 中 ， 其 中 ， 


一 个 命令 


组 合 模块 作为 一 个 伸 裁 者 ， 将 多 输出 模糊 行为 合并 到 
一 个 单一 控制 信号 中 。 这 种 策略 保证 了 机 器 人 在 不 确 


定 情 况 下 能 够 做 出 推理 。 


基于 行为 的 方法 从 一 开始 就 被 应 用 


到 多 机 器 人 系 


统 中 翌 汪 1 。 为 了 概述 和 讨论 方便 ， 最 近 研究 多 机 咒 
人 系统 的 学 者 开始 考虑 解决 那些 需要 紧密 合作 的 任 


务 ， 见 参考 文献 【38.74]。 这 
别 的 传感器 共享 和 /或 更 高 级 另 


些 工 作 通常 需要 低级 
的 传感器 共享 具体 协 


作 。 已 经 发 展 和 扩展 基于 行为 的 控制 器 以 应 对 这 些 挑 
战 。 例 如 ，Parker 等 考虑 了 对 于 底层 信息 处 理 进 


行 自动 重新 分 布 的 可 重复 使 


] 的 行为 单元 。Werger 


等 (37 描述 了 通过 局 部 资格 


播 ， 使 得 高 层 集群 行 


为 通过 通信 来 影响 每 个 机 器 人 的 动作 选择 机 制 。Ger- 


key 等 ”引证 明了 基于 市 场 的 多 机 器 人 的 协调 算法 


在 各 种 多 任务 中 具有 可 扩展 性 和 高 效 性 ， 包 括 需 要 紧 


密 合作 的 任务 (如 推 箱子 任务 ' 


38. 79] ) 
o 


一 些 研 究 者 已 经 证 明 ， 基 于 行为 的 控制 顺 允 许 通 
过 一 个 以 集体 任务 为 中 心 的 实用 模式 来 进行 复杂 的 协 
调 。 用 这 种 方法 表示 行为 ， 能 够 产生 那些 考虑 到 每 个 
机 器 人 对 作为 整个 群体 的 行为 都 有 影响 的 行动 ，1oc- 
chi ^ 7*9! 在 异 构 多 机 器 人 系统 中 已 经 将 这 种 情况 显 


示 出 来 了 ， 而 Batalin EXE BET 


控制 融 与 传感器 网 络 相互 作用 ， 


方式 来 执行 复杂 的 、 相 互 关 


F 明 ， 通 过 基于 行为 的 


并 且 按 照相 互 协 作 的 
联 的 和 动态 的 任务 。 


Stroupe 等 1 认为 映射 任务 以 及 成 熟 的 机 器 人 团队 
的 价值 估计 (MVERT) ， 实 质 上 是 一 种 最 大 限度 地 发 


挥 群体 知识 的 基于 行为 的 方法 。 
由 于 基于 行为 的 方法 能 够 很 自然 地 应 用 到 多 机 器 


人 控制 问题 中 ， 这 使 得 他 们 在 这 一 研究 领域 中 产生 了 


重大 的 影响 。Simmons 等 *31 描 述 了 一 种 混合 架构 设 


计 用 于 组 级 间 的 协调 ， 该 设计 以 行为 作为 组 织 低级 别 


安全 的 关键 控制 器 代码 的 方法 


。 在 最 低 限度 系统 中 ， 
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行为 也 被 用 来 构建 控制 器 和 网 络 通信 ' 基 ” 。 有 些 含 
有 控制 论 特点 的 多 机 器 人 研究 成 果 已 经 能 够 使 用 单独 
可 执行 进程 来 处 理 任务 ， 这 些 进程 可 以 根据 任务 的 约 
束 条 件 动态 地 开启 或 关闭 ， 这 与 基于 行为 的 控制 方式 
SE AA 。 
示 教 学 习 也 被 结合 到 基于 行为 的 系统 中 ， 以 产生 
1 用 于 机 器 人 控制 的 一 杆 式 教 学 机 制 关 5 。 此 外 ， 
这 种 基于 行为 的 结构 类 型 已 用 于 船舶 航行 学 习 策 略 
PIX 在 一 个 学 习 阶 段 里 ， 示 教 者 为 船舶 选择 要 
执行 的 行为 ， 以 实现 一 个 具体 的 目标 ， 随 后 是 一 个 离 
线 阶段 ， 这 个 阶段 与 那些 已 学 习 阶 段 中 学 习 的 行为 产 
生 相互 依赖 关系 。 
男 一 种 类 型 的 示 教 学 习 形 式 利用 概率 方法 来 选择 
MASE MEAT 。 该 方法 将 自主 导航 中 执行 何 
种 行为 学 习 的 问题 视 为 一 个 状态 估计 问题 。 在 一 个 学 
阶段 里 ， 机 器 人 观察 示 教 者 发 出 的 命令 。 然 后 粒子 
过 滤器 融合 示 教 者 所 发 出 的 控制 命令 来 评估 行为 激活 
程度 。 该 方法 能 够 产生 非常 适合 动态 环境 的 鲁 棒 控 
DL 
基于 行为 的 架构 也 被 用 在 复杂 视觉 系统 中 ， 用 于 
识别 ， 而 非 控制 。 在 这 些 情况 下 ， 一 个 行为 代表 一 个 
视觉 计算 的 小 单元 ， 如 框架 差分 、 运 动 检测 、 边 缘 检 
WY, 这 就 导致 了 生物 激励 视觉 和 注意 行为 的 
pp SHR O38. 88.89] 。 
基于 行为 的 架构 也 被 开发 用 于 类 人 机 器 人 的 控制 
和 学 习 。 图 38.4 显示 了 两 个 用 于 正在 执行 任务 的 机 
器 人 。 过 去 ， 齿 轮 设计 展示 了 基于 行为 控制 的 人 工 关 
节 和 手眼 协调 5 ”2 。 Edsinger 58921 组织 开发 了 一 个 
轻 量 级 的 行为 架构 用 于 感知 和 Domo 控制 。 该 架构 允 
许 偶然 的 行为 规范 和 分 布 式 计 算 ， 这 就 形成 一 个 实时 
控制 器 ， 人 允许 Domo 和 人 在 同一 环境 里 工作 。kKis- 
met*”1 提 及 了 几 种 基于 行为 的 系统 ， 在 人 一 机 交互 
(HRI) 范围 内 ， 这 些 系 统 控制 机 器 人 的 知觉 、 动 机 、 
注意 、 行 为 和 运动 。 每 个 行为 代表 Kismet 提 到 的 单独 
驱动 和 动机 。 已 设 的 模块 和 插入 规则 集 被 用 作 由 Ish- 
iguro "4! 和 Kanda 等 构建 的 HRI 结构 的 一 部 
分 天” ， 他 们 采用 一 个 带 有 通用 设置 模块 和 带 偶发 
行为 的 有 序 装 置 ， 用 在 由 特定 工作 搬入 规则 集 定义 的 
序列 当中 。 
证 机 器 人 能 安全 有 效 地 在 现实 世界 中 与 人 交互 
是 机 器 人 学 上 的 一 个 终极 挑战 。 为 了 适应 日 益 复 杂 
的 环境 和 任务 ， 表 示 方 法 与 抽象 推理 变 得 越 来 越 
重要 。 
一 种 可 能 的 解决 方案 是 在 基于 行为 的 体系 结构 中 
意识 地 添加 关于 激活 、 监 控 和 配置 行为 的 思想 。 这 


n 
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图 38.4 用 于 人 一 机 交互 的 基于 行为 的 控制 系统 


a) 南 加 州 大 学 Bandit b) 谢 布鲁克 大 学 Melvin 


些 行为 被 认为 是 可 以 根据 机 器 人 的 意 岁 来 选择 和 修改 
的 基本 控制 组 件 *”%””]。 这 种 意图 也 通过 多 元 的 影 
响 来 遵守 基于 行为 的 系统 的 分 布 式 上 哲学。 行为 的 动机 
架构 (Motivated Behavioral Architecture, MBA) 使 用 
激励 模块 以 获取 机 器 人 的 意图 。 

激励 模块 控制 机 器 人 任务 的 激活 和 抑制 。 所 谓 的 
任务 就 是 与 具体 配置 以 及 一 个 或 多 个 行为 的 激活 有 关 
的 数据 结构 。 机 器 人 的 意图 处 理 是 通过 动态 任务 工作 
区 (Dynamic Task Workspace, DTW) 来 完成 的 。 工 
作 区 根据 各 任务 间 的 相关 性 ， 按 照 从 高 级 的 抽象 任务 
(如 传送 信息 ) 到 与 原始 行为 有 关 的 任务 (如 避 障 )， 
将 任务 组 织 成 一 个 树 状 结构 。 通 过 DTW 和 任务 描 
述 ， 激 励 模块 通过 提交 变更 请 求 和 查询 ， 或 者 签署 
有 关 任 务 状态 事件 的 手段 来 异步 地 交流 如 何 激活 、 
配置 和 监督 行为 等 信息 。 激 励 模块 可 以 同时 触发 多 
个 任务 ， 根 据 有 无 特定 配置 〈 例 如 ， 到 达 目 的 地 ) 
的 建议 ， 行 为 激活 和 配置 模块 可 以 确定 哪些 行为 被 
激活 。 建 议 可 以 是 消极 的 、 中 立 的 或 者 积极 的 ， 或 
是 呈现 能 够 反映 机 器 人 完成 特定 任务 的 在 一 定 范围 
内 的 真 值 。 由 行为 激活 和 配置 模块 实现 的 抉择 过 程 
(由 设计 者 设 定 ， 该 过 程 可 采用 不 同 的 动作 选择 方 
式 ) 利用 这 些 信 息 来 激活 行为 ， 由 此 产生 的 激活 值 
反映 的 是 机 器 人 从 激励 模块 间 的 交互 中 获得 的 意图 。 
行为 和 其 他 信息 (任务 描述 和 监测 机 器 人 使 用 什么 
样 的 行为 与 环境 交互 ) 也 是 通过 行为 激活 和 配置 模 
块 来 进行 交流 的 。 

激活 模块 可 分 为 本 能 的 、 理 性 的 或 情感 的 。 本 能 
激活 模块 通过 使 用 简单 的 规则 为 机 器 人 提供 基本 的 操 
作 。 理 性 激活 模块 与 认 知 过 程 相 关 ， 例 如 导航 和 规 
划 。 情 感激 活 模块 监测 任务 间 的 冲突 和 变迁 状况 ， 例 
如 改变 机 器 人 在 其 环境 中 建立 起 的 与 其 他 智能 体 
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(人 或 者 机 器 人 ) 的 契约 。 因 此 该 机 器 人 的 行为 表现 
能 够 相应 地 受到 直接 感知 、 推 理 或 契约 的 管理 和 选择 
的 影响 。 根 据 它们 的 作用 来 分 配 激励 模块 ， 并 有 效 地 
利用 和 结合 在 机 器 人 完成 任务 中 产生 的 各 种 影响 。 基 
于 机 器 人 的 现 有 能 力 ， 通 过 与 DTW 交换 信息 ， 考 虑 
到 行为 配置 以 一 个 分 布 式 方式 产生 ， 激 励 模块 间 保 持 
通用 且 互 相 独 立 。 例 如 在 DTW 中 ,一 个 本 能 的 激励 
可 以 监测 机 器 人 的 电量 水 平 并 发 出 充电 任务 信号 ， 激 
活 充电 行为 ， 使 机 器 人 探测 并 进入 一 个 充电 站 。 与 此 
同时 ， 如 果 机 器 人 知道 附近 的 充电 站 在 哪里 ， 并 确定 
到 达 附 近 充 电站 的 一 条 路 线 ， 则 一 个 导航 子 任务 将 加 
入 到 路 径 规 划 的 理性 激励 ， 并 通过 一 个 继续 行为 到 达 
这 个 位 置 。 否 则 ， 当 机器 人 检测 到 一 个 充电 站 ， 充 电 
行为 将 至 少 会 同意 机 器 人 寻找 机 会 去 充电 。 
在 一 个 叫做 Spartacus 的 机 器 人 上 使 用 之 前 所 描 
述 的 体系 结构 来 集成 许多 智能 决策 功能 ， 如 图 38.5 
所 示 。 在 美国 人 工 智能 协会 (AAAI) 的 移动 机 器 人 
竞赛 中 , Spartacus 被 用 于 证 明 一 个 基于 行为 的 系统 能 
够 通过 使 用 先前 生成 的 度量 地 图 ， 根 据 时 间 限 制 和 空 
间 定 位 能 力 来 综合 规划 和 测序 任务 。 系 统 读 取 行为 信 
息 *”， 使 用 8- 麦 克 风 系统 的 音频 处 理 来 进行 源 定 
位 、 跟 踪 、 实 时 声音 分 离 .“” ， 触 摸 屏 接口 实现 
了 机 器 人 获取 它 在 哪里 、 应 该 做 什么 、 怎 么 去 做 等 
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图 38.5 Spartacus 
a) 前 视图 b) 后 视图 


图 38.6 所 示 为 Spartacus 所 应 用 的 导航 部 分 的 结 
构图 。 行 为 动作 选择 机 制 是 基于 优先 级 的 ， 行 为 建议 
和 激活 是 二 元 的 。 使 用 的 行为 有 : 停止 /休息 ， 紧 急 
情况 停止 或 需要 与 人 进行 图 形 界 面 互动 时 停止 ， 避 
障 ， 确 保 机 器 人 在 环境 中 安全 运行 ;服从 命令 ， 要 求 


执行 声音 导航 ; 再 充电 ， 当 等 待 进 入 一 个 充电 站 时 停 
止 机 器 人 运行 ; 转 到 ， 指 挥 机 器 人 到 特定 位 置 ; 声音 
跟踪 ， 让 机 器 人 跟踪 声 源 ; 墙壁 跟踪 ， 当 侦 测 到 墙壁 
(或 走廊 ) 时 沿 着 墙壁 (或 走廊 ) 行走 ， 和 否则 以 恒定 
的 速度 前 进 。 在 这 个 结构 中 只 存在 本 能 激励 和 理性 激 
励 ， 且 在 发 生 冲 突 时 理性 激励 比 本 能 激励 有 更 高 的 优 
先 级 。 对 于 本 能 激励 ， 在 尚未 有 优先 级 时 ， 任 务 选 择 
器 将 优先 选择 高 水 平 的 任务 。 例 如 ， 相 比 于 要 求 机 器 
人 到 达 指 定位 置 的 任务 ， 激 励 将 会 选择 距离 机 器 人 最 
近 的 任务 。 安 全 导航 要 求 机 器 人 通过 建议 避 障 来 保证 
自身 安全 。 对 于 理性 激励 ， 在 时 间 限 制 和 能 力 有 限 的 
情况 下 ， 设 计 者 确定 对 于 完成 高 水 平 任务 所 必要 的 原 
始 任务 及 其 优先 级 顺序 。 第 一 种 实现 是 一 种 简单 的 无 
功 规 划 模 块 ， 它 是 交错 规划 和 执行 的 ， 在 参考 文献 
[38.103-105] 中 有 人 介绍。 导航 器 按照 DTW 中 规定 
的 任务 确定 到 达 特 定位 置 的 路 径 。 议 程 产生 预定 的 任 
务 序列 去 执行 。 


动作 选择 


图 38. 6 基于 行为 的 分 布 式 体系 结构 与 激励 模块 


上 述 体系 结构 的 基本 原则 已 经 在 不 同 功 能 的 机 器 
人 中 得 到 了 应 用 ， 例 如 ， 使 用 激活 变量 、 拓 扑 定位 及 
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映射 、 


探索 和 描述 环境 的 模糊 行为 的 机 器 全 了 ”1 ; 


在 一 个 仅 使 用 一 些 简单 的 传感器 和 一 个 微 控制 器 即 可 
产生 特定 运动 的 幼儿 互动 研究 项 目 中 所 使 用 的 自动 旋 
转机 器 人 中 "ol 。 为 了 使 机 器 人 在 日 常生 活 中 具备 
更 加 有 用 和 高 效 的 技能 ，MBA 结构 现在 已 经 被 应 用 


于 机 絮 人 ， 以 满足 日 益 增长 的 感知 和 行动 能 力 的 


需求 。 
38.7 ”结论 与 扩展 阅读 


本 童 描述 了 处 于 非 约束 、 复 杂 、 
中 单机 器 人 或 多 机 器 人 的 基于 行为 的 控制 方法 。 受 


动态 变化 环境 


哲学 中 反应 控制 的 启发 ， 基 于 行为 的 系统 本 质 上 具 


Eu 


有 强大 的 表现 力 、 描 述 能 力 、 规 划 性 和 学 习 能 


作为 这 些 功能 


和 基本 构件 ， 分 布 式 行为 允许 基于 行 


为 的 系统 采用 与 环境 交互 的 先进 机 制 ， 而 不 是 仅仅 


依靠 确定 的 推理 和 规划 。 随 着 机 器 人 复杂 性 的 不 断 


增加 ， 


基于 行为 的 理论 及 其 在 机 器 人 体系 结构 中 的 


应 用 将 会 得 到 更 多 的 发 展 ， 并 会 显示 出 越 来 越 高 的 


智能 性 和 自主 性 。 


兴趣 的 读者 可 以 在 本 书 中 的 其 他 章节 以 及 


其 他 书 中 找到 关于 基于 行为 系统 的 更 多 信息 ， 例 
如 Brooks?* 11 和 Arkin 2723 的 书 、 人 工 智能 及 机 
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分 布 式 和 单元 式 机 全 人 


Zack Butler, Alfred Rizzi 
伍 小 军 译 


本 章 按 照 数 个 能 证 明 模 块 化 机 器 人 系统 益处 的 
广泛 类 别 的 问题 来 组 织 。 对 于 每 一 个 问题 ， 我 们 描 
述 模块 化 的 好 处 ， 以 及 特定 的 或 者 拟定 的 系统 如 何 
探究 这 些 好 处 。 具 体 来 说 ， 在 第 39.1 节 ， 我们 讨 
论 位 置 移动 ， 第 39. 2 节 讨 论 机 器 人 操作 ， 第 39.3 
节 讨 论 模块 机 器 人 几何 学 ， 第 39. 4 节 讨 论 鲁 棒 系 
统 。 所 考虑 的 系统 一 般 在 每 一 个 模块 上 都 有 某 种 程 
度 的 独立 计算 ， 本 章 集中 讨论 在 工作 中 模块 之 间 保 
有 某 种 运动 学 约束 的 系统 。 相 比 于 第 40 章 描述 的 
多 机 吉 人 队伍 类 型 ， 本 章 关 注 的 系统 一 般 在 物理 上 
和 概念 上 更 紧密 的 耦合 。 也 就 是 说 ， 我 们 主要 关注 
的 系统 虽然 拥有 多 个 处 理 器 和 独立 的 致 动 器 ， 但 是 
它们 的 单个 目标 或 者 小 的 目标 集合 只 能 协同 取得 ， 
而 不 能 将 一 系列 目标 单独 分 配给 队伍 中 的 一 个 
(或 数 个 ) 机 器 人 。 


对 许多 机 器 人 任务 类 别 ， 包括 操纵 和 位 置 移动 ， 
具备 不 同 运 动 学 的 机 絮 人 能 最 好 地 完成 不 同 的 任务 实 
例 。 例 如 ， 足 式 机 器 人 和 轮 式 机 器 人 都 可 以 有 效 地 移 
动 ,但 是 每 一 种 类 型 有 更 适合 的 特定 的 环境 类 型 
(粗糙 或 者 比较 平滑 ) 。 类 似 地 ， 具 备 不 同 几何 构造 
的 机 械 手 能 在 不 同 的 运动 空间 取得 好 的 操控 性 。 在 机 
器 人 中 应 用 模块 化 ， 不 论 是 为 单个 机 器 人 开发 物理 上 
可 互 换 的 零件 还 是 创建 完全 独立 但 可 以 连接 到 一 起 以 
适应 状况 要 求 的 机 器 人 ， 使 得 单个 综合 的 机 器 人 系统 
能 获得 固定 机 构 所 不 能 的 多 种 运动 学 构造 。 


运动 模块 化 


模块 化 机 器 人 能 够 生成 很 多 种 不 同 的 形式 以 适应 
在 粗糙 地 形 上 的 运动 (甚至 是 通过 ) 。 单 个 机 器 人 系 
统 可 以 越过 相当 于 机 器 人 本 身 尺 十 数 倍 的 障碍 物 ， 也 
能 通过 比 本 映 尺 寸 稍 大 的 隧道 。 有 些 系统 设计 成 主要 
用 于 多 模式 移动 ， 虽 然 其 他 更 通用 的 机 器 也 能 执行 这 
种 移动 但 是 效率 较 低 。 


39.1 


39.1 运动 模块 化 pe 373 
39. 1.1 我 重组 型 机 器 人 运动 373 
39.1.2 物理 协作 移动 机 器 人 pp 375 

39.2 ”机 右 人 操纵 的 模块 化 ……………… 376 
39.2.1 独立 机 械 手 eH 376 
39.2.2 可 重 构 机 械 手 .ppp 376 

39.3 ”几何 重组 型 机 器 人 系统 的 模块 化 ………… 377 
39.3.1 手动 重 构 系 统 pp 377 
39.3.2 ”自动 重 构 型 系统 的 外 形 生成 ………… 377 
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39.1.1 自我 重组 型 机 器 人 运动 


自我 重组 型 机 器 人 系统 潜在 功能 强大 ， 各 模块 彼 
此 互相 移动 ， 根 据 不 同 目的 自动 形成 不 同 的 构造 。 根 
据 模块 系列 在 空间 上 如 何 排列 ， 迄 今 为 止 的 这 种 系统 
一 般 分 为 两 个 类 别 ， 即 链 式 和 阵列 式 。 链 式 系统 构成 
可 连续 移动 的 一 维 骨 架 结构 ， 而 阵列 式 结构 倾向 于 
空间 填充 模块 组 成 相对 更 密集 的 二 维 或 者 三 维 构造 ， 
如 图 39. 1 所 示 。 

在 链 式 系统 中 ,模块 通常 以 链 的 形式 彼此 连接 ， 
大 部 分 的 模块 都 在 自身 旋转 轴 方 向 与 其 他 两 个 模块 相 
接 。 额 外 的 连接 模块 可 提供 更 复杂 的 结构 ， 例 如 多 足 
式 蜂 蛛 ， 轮 式 和 蛇 形 机 器 人 。 这 种 系统 的 例子 包括 
PolyBotP? 0 和 可 重 构 机 器 人 (CONRO) AREE, 
建造 链 式 系统 主要 有 两 个 挑战 。 首 先 ， 重 构 系 统 的 控 
制 是 一 个 有 趣 的 运动 学 问题 一 一 将 一 条 蛇 变 成 环 需要 
协调 所 有 的 关节 ， 使 蛇 的 首尾 两 端 足够 靠近 来 进行 物 
理 连 接 。 这 类 似 于 将 计算 量 分 布 到 系统 各 个 关节 的 传 
统 逆 运 动 学 。 


a 
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a) 


图 39.1 
a) Polybot， 链 式 系统 [32.11 


自我 重 构 机 器 人 范例 
b) Crystal， 一 个 二 维 阵列 式 系统 9-21 


c) MTRANP?3J, A 


一 旦 链 式 系 统 形成 给 定 的 构造 ， 为 了 在 地 形 上 前 
进 ， 模 块 必须 生成 周期 性 的 步 态 。 步 态 的 定义 通常 类 
似 于 足 式 系 统 ， 即 每 一 关节 都 有 相对 于 时 间 的 角度 规 
划 。 这 里 的 挑战 在 于 步 态 将 依赖 于 配置 一 一 不 同 长 度 
的 蛇 形 机 器 人 需要 不 同 的 步 态 ， 足 式 架构 的 足 数 变动 
也 是 可 能 的 。Zhang 等 人 关于 Polybot 系统 的 研 


备 链 式 和 阵列 式 两 种 特征 


使 得 这 类 机 器 人 可 以 构建 出 不 同 的 形状 ， 从 而 可 以 跨 
越 更 大 的 障碍 ， 但 是 移动 效率 会 较 低 。 例 如 ， 轮 式 或 
者 足 式 构造 的 链 式 系统 不 能 够 比 传统 的 轮 式 或 者 足 式 
机 器 人 攀 越 高 很 多 的 障碍 ， 但 是 阵列 式 机 器 人 利用 模 
块 能 够 产生 类 似 脚 手 架 的 形状 ， 该 形状 只 受 限 于 可 用 
模块 数量 ， 梦 越 障 碍 后 模块 在 障碍 物 的 男 一 面 重组 。 


究 ”5 描述 了 一 系列 可 缩放 的 配置 形态 (R, Æ 
A, NOE), ， 不 同形 态 之 间 的 自动 变换 和 自动 步 态 的 
生成 。 该 研究 利用 相位 自动 机 产生 每 一 个 关节 的 周期 


这 里 硬件 的 属性 变 得 很 重要 ， 因 为 这 些 系统 通过 重 构 
来 产生 位 移 ， 也 就 是 说 ， 模 块 会 逐个 越过 剩余 结构 从 
而 使 得 整 组 部 件 向 前 移动 。 图 39. 2 给 出 了 一 个 阵列 


性 角度 ， 角 度 的 规定 方式 可 以 随 着 配置 的 变化 而 很 容 
易 地 重新 计算 。 
阵列 式 系 统 中 的 模块 像 建 筑 材料 一 般 填充 空间 ， 


式 模块 的 范例 ， 模 块 通过 压缩 和 扩张 驱动 ， 以 固定 的 
运动 序列 爬 越 台 阶 。 


图 39.2 一 个 由 可 压缩 模块 组 成 的 自我 配置 机 器 人 岭 越 一 个 相当 于 模块 两 们 高度 的 台阶 


在 参考 文献 [39.6] 中 ,通过 改变 形状 来 移动 
位 置 被 定义 为 一 种 单元 自动 机 的 结构 一 一 在 这 项 研究 
中 ， 每 一 个 模块 独立 运行 一 系列 几何 法 则 ， 取 决 于 相 
邻 物体 的 状态 (不论 相 邻 的 是 其 他 模块 或 者 障碍 ) 
而 沿 给 定 的 方向 移动 。 对 于 不 平地 形 上 的 直线 移动 ， 
越过 相当 于 模块 本 身 数 倍 高 的 峭壁 或 者 狭窄 的 坑道 ， 
在 平坦 地 面 上 转弯 等 ， 这 种 技术 可 以 确保 机 器 人 前 进 
并 防止 死 锁 , 但 是 并 不 容易 将 其 推广 至 更 复杂 的 
操作 。 

阵列 式 机 器 人 有 更 广泛 的 模块 类 型 。 有 些 系 统 
为 纯 平面 类 型 (例如 ， 参 考 文献 [39.9，10] ) ， 另 


外 一 些 为 三 维 〈 例 如 ， 参 考 文献 【39.11] ) 。 模 块 
可 以 是 简单 的 立方 体 或 者 更 复杂 的 形状 ， 虽 然 一 般 
情况 下 单个 模块 不 足以 执行 重要 的 运动 ， 而 需要 连 
接 到 其 他 的 模块 来 一 起 运动 。 模 块 之 间 的 连接 可 以 
Fe BL pi sU sk o» dE EJ] XU, 参考 文献 
[39.6] 中 提出 了 一 种 通用 的 立方 体 模块 模型 ， 可 
以 平移 越过 其 他 模块 ， 进 行 突 出 转换 ， 该 文献 也 展 
现 了 用 几 种 不 同 的 硬件 系统 可 以 完成 该 模型 (虽然 
有 些 需 要 多 个 硬件 模块 ， 称 为 多 模块 ， 来 产生 一 个 
通用 模块 ) 。 

近来 ， 出 现 了 衔接 这 两 种 不 同类 型 模块 机 器 人 
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的 新 硬件 ， 这 种 硬件 可 以 在 链 式 和 阵列 两 种 模式 下 
THE. 模块 化 变形 机 器 人 (MTRAN) 和 其 后 
EU 中 由 二 自由 度 模块 组 成 ， 每 一 模块 包含 有 两 个 
半圆 柱状 部 件 ， 可 绕 它 们 之 间 的 连接 旋转 。 模 块 的 
两 个 半圆 部 件 都 能 够 与 其 他 模块 之 间 通 过 磁力 连接 
件 建立 三 个 连接 ,磁力 连接 件 只 有 断 开 连 接 的 时 候 
需要 额外 的 电源 。 该 机 器 人 也 能 以 完全 无 线 的 模式 
运行 ， 包 括 连接 与 断 开 ,是 真正 的 自我 重 构 。 该 系 
统 已 经 展示 了 和 矩阵 式 自我 重 构 (阵列 的 离散 本 质 使 
得 运动 学 和 对 接 问 题 简单 很 多 ) ， 之 后 通过 串联 模 
块 的 关节 变形 为 四 足 行走 机 咒 人 。Superbot BL at 
人 "中 是 最 近 研 发 的 另外 一 款 系 统 ， 因 为 每 个 模块 
有 额外 的 一 个 自由 度 ， 所 以 它 至 少 可 以 实现 跟 
MTRAN 一 样 的 功能 ， 但 是 目前 物理 上 自动 连接 与 断 
开 的 功能 还 在 研发 当中 。 

在 所 有 这 些 系统 中 ， 构 建功 能 性 和 重 棒 性 的 硬 
件 是 关键 挑战 所 在 。 主 要 的 考虑 是 连接 机 构 一 一 这 
些 机 器 人 需要 相当 坚固 的 连接 ,通常 包 括 多 个 用 于 
通信 和 /或 电力 传送 的 电气 连接 ， 为 此 ， 物 理 连 接 也 
是 允许 的 ， 即 便 要 面 对 位 置 误差 。 位 置 误差 可 通过 
传 感 来 处 理 ， 例 如 CONRO 系统 中 使 用 的 多 个 信号 
灯 ， 或 者 通过 机 械 方式 ， 例 如 分 子 机 器 人 中 使 用 的 
夹具 。 连 接 部 件 对 阵列 式 系统 来 说 更 为 关键 ， 因 为 
后 者 必须 进行 连接 或 者 断 开 来 反映 任何 的 几何 变化 。 


39. 1.2 物理 协作 移动 机 器 人 


在 其 他 情况 下 ， 位 置 移 动 的 要 求 可 能 很 直接 ， 只 
有 一 些 特 别 领域 需要 不 寻常 的 功能 。 在 这 些 情 况 下 ， 
使 用 传统 的 移动 机 器 人 作为 模块 可 能 更 合适 ， 这 样 的 
机 器 人 可 以 独自 有 效 地 移动 ， 也 可 以 通过 刚性 或 者 半 
刚性 连接 来 获得 更 强 的 功能 。 

一 个 例子 是 由 Hirose 等 人 提出 的 Gunryu 系 
BEEP!) 。 在 该 系统 里 ， 每 一 个 模块 均 是 单独 的 履带 
式 移 动机 器 人 ,长 约 0.5m， 并 安装 有 两 个 关节 组 成 
的 手臂 。 每 一 个 模块 可 以 自动 在 中 等 难度 的 地 形 中 
移动 。 当 遇 到 很 陡峭 的 地 形 或 者 地 面 的 孔洞 比 单个 
模块 自身 还 大 ， 模 块 可 以 利用 它 的 机 械 手 臂 抓 住 另 
外 一 个 模块 。 文 献 作 者 演示 了 两 个 连接 在 一 起 的 模 
块 能 够 比 单个 模块 越过 更 宽 的 地 面 。 这 项 功能 的 关 
键 是 机 械 手 的 强度 ， 它 必须 足够 坚硬 以 承受 另外 一 
个 模块 的 重量 。 一 个 更 近 研 发 的 称 为 Ashigaru 的 机 
器 人 ， 它 的 每 个 模块 有 三 条 腿 ， 因 为 每 一 条 腿 能 充 
作 爪 义 ， 所 以 能 独立 执行 简单 朴 行 。 该 机 器 人 的 演 
示 包 括 变形 为 四 足 动物 和 六 足 虫 ( 见 图 39.3a) JE 
越 比 单个 模块 所 能 息 越 更 高 的 台阶 ， 甚至 于 以 其 他 


模块 抓 住 一 个 模块 并 用 它 作 为 简单 的 机 械 手 。 当 前 ， 
该 机 器 人 通过 手动 重 构 ， 但 是 自我 重 构 的 功能 已 在 
计划 之 列 P 7 。 


图 39.3 单独 可 工作 的 移动 机 器 人 彼此 连接 
来 执行 更 困难 任务 的 范例 
a) Ashigaru A367) 的 三 个 模块 组 合成 六 足 行走 机 器 
人 b) 蜂 群 机 器 人 '” 引 彼此 连接 通过 一 个 比 自身 尺寸 
更 宽 的 空隙 


在 这 个 方向 上 ， 蜂 群 机 器 人 (SWARM- BOTS ) 
项 目 正 在 执行 一 项 更 广泛 的 工作 '*”'。 该 系统 中 的 
模块 要 小 很 多 ( 圆 形 机 器 人 ， 直 径 120mm), ， 但 是 都 
有 一 个 类 似 的 夹具 能 够 夹 住 其 他 模块 来 协同 位 移 。 在 
这 种 情况 下 ,夹具 与 其 说 是 串联 型 的 机 械 手 ， 更 像 是 
一 个 两 自由 度 的 腕 关节 ， 可 以 获得 更 大 的 刚度 。 在 演 
示 中 这 些 模块 能 够 穿 过 比 模块 直径 更 宽 的 间隙 ， 如 图 
39. 3b Stas! 8! 。 每 一 个 模块 也 都 有 一 个 短 的 串联 机 
械 手 可 执行 多 种 操作 任务 ， 文 献 中 也 用 整体 系统 演示 
了 简单 的 协同 操纵 。 
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39.2 机 器 人 操纵 的 模块 化 


需要 操纵 多 种 负载 时 ， 模 块 化 有 极 大 的 好 处 。 特 
别 是 ， 操 纵 系统 的 运动 学 能 够 快速 改变 (在线 或 者 
离线 ， 取 决 于 系统 ) 使 得 工作 空间 和 可 操纵 性 对 于 
给 定 的 任务 是 最 合适 的 。 


39.2.1 独立 机 械 手 


更 适合 用 一 组 机 器 人 协作 处 理 的 一 个 常见 任务 是 
推 或 运送 一 个 大 的 物体 。 如 果 物 体 明显 大 于 单个 机 器 
人 所 能 处 理 的 尺寸， 组 机 器 人 是 将 该 物体 在 环境 
中 移动 的 唯一 方法 。 实 现 这 样 的 一 个 系统 时 ， 关 键 问 
题 包括 数据 传输 的 频率 和 负载 的 有 效 共享 。 为 了 让 机 
器 人 保持 对 物体 的 控制 ， 必 须 共享 内 部 受 力 使 得 没有 
单个 机 器 人 过 载 。Khatib $5 A C^ 17 4818 T Here BEE 
为 该 问题 的 解 。 

在 准 静 态 物体 推动 问题 中 ， 受 力 控制 比较 少 受 关 
注 一 一 该 情况 下 的 挑战 是 ， 每 一 个 推 的 机 器 人 的 作用 
力 范 围 有 限 的 情况 下 ， 应 该 如 何 产生 被 推 物体 的 合适 
轨迹 。 在 这 样 的 系统 中 ,同步 依然 重要 ,但 是 ，Ma- 
taric 等 人 '”* 证 明了 用 两 个 足 式 机 器 人 可 以 协同 推 
动 单个 机 器 人 推 不 动 的 盒子 ， 并 表明 一 般 在 没有 同步 
的 情况 下 ， 一 个 机 器 人 会 比 另 一 个 移动 更 快 ， 因 此 使 
盒子 定向 错误 或 者 将 盒子 推 过 终点 。 在 该 文献 中 ， 机 
器 人 的 同步 是 通过 明确 的 通信 和 时 间 分 割 控制 ， 也 就 
是 说 ， 每 一 个 机 器 人 移动 一 段 时 间 之 后 ， 将 控制 
(和 传感器 信息 ) 交 给 同伴 。 这 种 分 割 同步 并 不 总 是 
必需 的 ， 但是， 如 果 机 器 人 具备 足够 的 传 感 和 对 顶 推 
任务 的 力学 理解 ， 那 么 它们 能 够 在 项 推 任务 中 进行 内 
在 的 合作 。 也 就 是 说 ， 当 被 推 的 物体 移动 时 ， 每 一 个 
机 器 人 可 以 推断 出 整个 系统 的 状态 并 选择 合适 的 动作 
和 和 角色。 这 种 任务 机 理 中 的 信息 理论 由 Donald 等 
人 号 中 提出 ， 并 提供 了 一 系列 虚拟 和 现实 信道 之 间 
的 变换 。 

协同 操纵 也 可 通过 非 移动 模块 取得 。 有 人 提出 了 
以 制造 为 导向 的 系统 ， 操 纵 模块 比 通常 预期 的 简单 很 
多 ， 因 为 很 多 模块 可 以 一 起 执行 某 项 要 求 的 任务 。 
Luntz 等 人 !* ”所 提出 的 虚拟 车 辆 就 是 这 样 的 一 个 系 
统 。 在 该 系统 中 ， 每 一 个 模块 只 是 简单 的 可 转动 轮 
子 。 将 很 多 个 这 种 轮子 在 有 限 的 区 域内 组 装 在 一 起 ， 
就 建立 了 一 个 可 编程 传送 带 。 系 统 可 在 不 同 的 点 同时 
处 理 多 个 物体 ， 并 可 以 不 同 的 方式 处 理 (例如 一 个 
物体 停 住 并 就 地 转动 ， 而 另 一 个 物体 被 传送 经 过 ) 。 
同样 的 ， 同 步 在 这 里 很 重要 一 一 物体 的 运动 由 它 所 受 


力 和 扭矩 的 总 和 决定 ， 力 和 扭矩 反 过 来 不 仅 取 决 于 下 
面 每 一 个 轮子 的 速度 和 和 角度， 也 取决 于 每 一 个 轮子 的 
相对 位 置 。 为 了 使 物体 保持 正确 的 轨迹 ， 当 物体 移动 
2 irc Lie ser 当 
物体 移动 时 该 位 置 可 能 改变 。 处 理 这 种 复杂 度 的 一 种 
方法 是 简化 任务 使 得 作用 力 不 依 赖 于 时 间 ， 例 如 ， 以 
传送 带 的 模式 运作 ， 即 所 有 的 轮子 治 相同 方向 移动 扣 
或 让 系统 的 两 部 分 朝 彼 此 推 挤 来 将 物体 移动 到 指定 的 
位 置 。 

另外 一 个 允许 使 用 多 个 简单 机 器 人 的 多 模块 系 
统 是 Hollis 等 人 的 微型 工 坊 ( minifactory ) DE E 
统 的 四 自由 度 装配 工作 由 两 台 机 器 人 执行 ， 每 一 台 
机 器 人 具备 两 个 自由 度 。 d AE M io 
轴 (2-0) 机 械 手 , 男 外 一 台 是 X- 了 平面 电动 机 。 
机 器 人 的 简化 ， 特别 是 项 置 机 械 手 中 清除 了 中 行人 
动 链 ， 可 以 极 大 增加 精确 度 和 提高 微米 刻度 自动 装 
配 的 性 能 。 但 是 ， 由 于 该 系统 的 目标 是 进行 力 导 引 
装配 ， 故 要 求 两 个 独立 机 器 人 之 间 的 1kHz 控制 循环 
闭合 。 


39.2.2 可 重 构 机 械 手 


有 一 种 完全 不 同 的 操作 模块 化 是 让 传统 的 机 械 
手 可 以 很 容易 地 重建 或 者 重 构 来 取得 不 同 的 运动 学 。 
如 果 机 器 人 手 由 一 系列 相似 的 模块 化 部 件 (关节 ) 
构建 而 成 ， 这 些 模块 可 以 根据 需要 连接 成 任意 多 个 
自由 度 ， 并 具有 合适 的 工作 空间 。 可 重 构 模块 化 机 
械 手 (RMMS) 就 是 根据 这 样 的 目标 来 设计 
的 *”。 这 里 的 挑战 是 当 系 统 变化 的 时 候 自 动 计算 
反 向 运 去 动 学 和 动力 学 ， 实际 上 RMMS 提供 了 这 一 功 
能 ， 虽然 这 些 系统 通常 具备 集中 式 计 算 ，, 最 多 带 有 
局 部 关节 控制 器 。 模 块 化 带 来 的 简洁 性 可 以 极 大 化 ， 
即 每 一 个 模块 是 具备 二 进 制 驱动 的 连 杆 机 构 ， 也 就 
是 说 ， 只 有 两 种 可 能 的 状态 。 将 这 些 二 进 制 模块 按 
不 同 的 几何 ,不 同 的 架构 组 合 在 一 起 ， 选 用 同样 的 
部 件 可 以 生成 具备 不 同 工 作 空间 的 机 器 人 ! 忆 2 H 
于 工作 空间 是 空间 中 的 一 系列 散 点 ， 所 以 反问 运动 
学 不 是 闭合 形式 ， 故 此 处 运动 学 和 反 向 运动 学 不 连 
续 。 但 是 ， 控 制 方案 要 简单 很 多 ， 因 为 一 旦 理想 的 
连 杆 位 置 确定 ， 只 需要 很 少 反 馈 或 者 完全 不 需 反 人 馈 
来 将 机 械 手 端点 移动 到 给 定位 置 。 

自我 重 构 领 域内 最 早 描述 的 系统 之 一 是 Fukuda 
等 人 提出 的 单元 式 机 器 人 (CEBOT) ”站 。 该 系统 介 
于 纯 自 我 重 构 模 块 和 移动 机 器 人 之 间 ， 因 为 它 包 括 独 
立 可 移动 模块 ， 但 也 包括 非 移 动 模 块 ， 并 在 大 多 数 任 
务 中 需要 用 到 几 个 模块 。 在 CEBOT 描述 的 其 中 一 项 
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任务 中 ， 单 个 模块 能 够 通过 一 个 小 的 开口 进入 一 辆 坦 


男 一 方面 ， 在 微型 工 坊 (Minifactory) 项 目 中 ， 


克 ， 然 后 重 构成 一 个 更 大 尺寸 的 机 械 手 在 整个 坦克 空 
间 内 执行 操作 。 
几何 重组 型 机 器 人 系统 的 模 
块 化 


应 用 模块 化 可 以 令 包 含 很 多 独立 部 件 的 系统 用 
最 小 的 付出 在 不 同 任务 之 间 快 速 重 构 。 这 在 制造 系 


39. 3 


整个 系统 包括 传送 是 一 个 单一 模块 系统 的 一 部 分 。 所 
有 的 模块 都 遵从 一 个 通用 的 接口 ， 包含 硬件 和 软 
件 ” ”1 。 通 过 夹子 和 简单 的 接头 可 以 把 每 一 个 机 器 
人 置 于 系统 之 中 ， 从 而 允许 快速 重 构 。 机 絮 人 之 间 共 
享 一 种 通用 的 高 级 语言 和 集中 式 仿真 环境 ， 这 样 任务 
可 以 提前 在 系统 中 规划 。 当 模块 装配 时 ， 系 统 中 运送 
产品 的 机 絮 人 也 可 以 用 来 察看 所 有 部 件 放置 的 确切 位 
置 。 在 通用 框架 下 编写 的 任务 算法 ， 与 将 要 访问 的 确 


统 中 很 有 用 ,模块 可 以 执行 单独 操作 ， 也 可 进行 机 
项 人 重 构 ， 在 机 器 人 执行 任务 时 传感器 可 重新 定位 。 
在 这 两 种 情况 下 ， 需 要 考虑 几 个 问题 : 重 构 的 容易 
度 ， 确 定 当前 的 构 型 ， 为 特定 的 任务 选择 好 的 构 型 ， 
基础 任务 的 设计 一 一 任意 构 型 都 可 以 使 用 的 性 能 
算法 。 


39.3.1 手动 重 构 系统 


传统 制造 可 在 工作 间 进 行 ， 在 工作 间 中 单个 机 
器 人 可 以 访问 几 个 工作 台 以 执行 一 系列 装配 操作 。 
从 零件 的 角度 来 看 ， 这 些 工 作 间 设计 得 相当 模块 化 ， 
当 制 造 任务 改变 的 时 候 可 以 交换 产品 的 不 同 部 分 。 
几 个 工作 间 可 以 沿 着 一 条 传送 带 或 者 其 他 直线 机 制 
布置 来 创建 一 条 装配 线 。 尽 管 在 构造 上 可 能 相似 ， 
在 运行 中 工作 间 倾 向 于 彼此 独立 。 在 这 种 传统 的 布 
局 中 ， 进 度 安排 可 能 很 重要 ， 但 是 实时 交互 则 可 能 
性 不 大 。 


T 
4l 
m 
Vay 
a 


c 
= 


切 位 置 一 起 自动 上 载 。 这 种 机 制 允 许 从 仿真 的 装配 线 
平滑 而 有 效 地 切换 至 实际 操作 的 硬件 集合 。 


39.3.2 ”自动 重 构 型 系统 的 外 形 生成 


自我 重 构 型 机 器 人 ， 正 如 其 名 字 所 示 ， 能 够 自动 
改变 总 体外 形 以 适应 当前 的 任务 。 除 了 利用 这 种 能 
来 执行 各 种 移动 任务 ， 阵 列 式 系 统 特别 拥有 产生 几乎 
任意 三 维 形状 的 能 力 。 这 有 利于 生成 不 同 尺 寸 和 形状 
的 载体 、 机 械 手 或 者 其 他 设备 。 在 最 近 的 研究 中 ， 使 
用 多 样 化 模块 的 系统 受到 了 更 多 关注 ， 这 种 系统 中 每 
一 个 模块 的 功能 不 一 定 相同 “” 。 这 有 利于 在 任务 
中 将 镜头 或 其 他 特定 的 传感器 放置 于 不 同 的 位 置 ， 即 
使 系统 的 形状 保持 不 变 。 图 39. 4 给 出 了 一 个 从 椅子 
到 桌子 的 多 样 化 重 构 仿真 范例 一 一 在 这 种 方法 中 ， 首 
先 ， 系 统 不 考虑 模块 类 型 而 生成 期 望 的 形状 (用 模 
块 颜色 表示 )， 然 后 各 模块 在 物理 上 排序 到 正确 的 
位 置 。 


c) 


图 39.4 具有 椅子 形状 的 系统 通过 非 均匀 重 构 变 化 至 桌子 


为 执行 自我 重 构 ， 系 统 中 的 模块 需要 协作 来 规划 
运动 ， 以 形成 期 望 的 构 型 。 在 常见 的 实践 中 ， 模 块 不 
带 中 央 控 制 融 运 行 ， 但 是 某 种 规格 的 全 局 期 望 形状 会 
传送 给 所 有 的 模块 ， 然 后 每 个 模块 做 出 局 部 决定 是 否 
要 移动 以 及 要 移动 至 哪里 。 为 执行 重 构 ， 已 经 开发 了 
主要 针对 局 部 的 算法 和 全 局 规划 算法 。 


局 部 成 形 技术 趋向 于 以 连接 为 基础 ， 也 就 是 说 ， 
通过 列 出 模块 之 间 的 连接 来 规定 所 期 望 的 形状 。 每 
一 个 模块 负责 确保 有 合适 的 模块 与 它 连接 。Tomita 
等 人 首先 提出 一 种 这 种 性 质 的 针对 二 维系 统 的 形状 
生成 方案 ” ， 一 个 种 子 模块 在 其 环绕 的 连续 分 层 
中 收集 模块 ， 在 每 一 个 层 按照 全 局 设计 的 规定 收集 
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适合 的 模块 。 沿 相似 的 思路 ，Lipson 等 人 ”””1 通 过 
模块 来 构建 不 包含 传统 的 驱动 而 是 存在 于 移动 流体 
介质 中 的 形状 。 模 块 只 能 控制 何 时 何 地 允许 其 他 模 
块 与 其 相连 接 来 建造 期 望 的 形状 ， 因 此 基于 连接 的 
方案 就 很 自然 了 。 最 近 Klavins EA W T fe P9281 tit Gi 
了 使 用 种 子 模块 ， 而 是 使 用 反应 网 络 理论 来 允许 模 
块 随机 移动 (例如 在 外 力作 用 下 ) 来 智能 化 地 分 离 
和 重新 合并 ， 从 而 可 以 很 有 效 且 可 靠 地 取得 期 望 的 
形状 。 

全 局 技术 看 上 去 更 像 传统 的 路 径 规划 一 一 模块 探 
查 当 前 构 型 与 期 望 构 型 之 间 的 差异 ， 以 分 布 式 的 方式 
产生 路 径 以 使 模块 移动 到 空 的 位 置 。 一 个 有 趣 的 特征 
是 可 用 的 路 径 经 过 其 他 模块 的 表面 ， 因 此 不 论 何 时 需 
要 搜索 都 有 计算 可 用 ， 分 布 式 规划 就 很 自然 了 。 而 
且 ， 路 径 本 质 上 是 不 连续 的 ， 所 以 不 需要 应 用 人 工 约 
束 来 执行 规划 。 

这 里 我 们 主要 关注 两 点 : 第 一 ， 必 须 求解 匹配 
问题 ， 以 确保 每 一 个 目标 位 置 只 是 单个 模块 的 终点 ， 
并 且 考 虑 到 每 一 个 位 置 ; 第 二 ， 如 果 系 统 中 产生 并 
执行 多 个 规划 ， 必 须 避 免 死 锁 ， 且 保留 可 遍历 性 。 
要 解决 第 一 个 问题 ， 可 让 每 一 个 目标 位 置 都 由 一 个 
和 寺 别 的 模块 来 代表 ， 如 果 该 模块 可 以 填充 目标 位 置 ， 
就 让 该 模块 初始 化 路 径 搜索 。 并 且 ， 这 些 做 法 也 会 
每 次 生成 目标 形状 的 一 个 层次 ， 并 从 当前 形状 开始 
往外 扩展 。 每 一 次 单独 的 路 径 搜索 都 必须 只 有 一 个 
模块 填充 ， 或 者 执行 深度 优先 搜索 直到 找到 可 执行 
的 模块 (参考 文献 [39. 29] 中 使 用 的 就 是 这 种 方 
法 ) ， 或 者 当 有 多 个 模块 试图 填充 所 请 求 的 位 置 时 ， 
用 其 他 方法 来 选择 模块 。 模 块 只 有 当 不 需要 保持 在 
它们 的 当前 位 置 ， 并 且 不 需要 与 总 体 结 构 脱 开 就 可 
以 移动 的 情况 下 ， 才 能 尝试 移动 。MelGrow'5 ^? f 
它 的 后 续 方 法 MeltSortGrow， 以 下 列 方式 处 理 第 二 个 
问题 : 将 所 有 的 模块 移动 到 一 个 中 间 形 状 (直线)， 
此 时 能 够 在 本 地 检测 到 直线 的 端点 ， 只 有 位 于 端点 
的 模块 才 会 移动 到 目标 位 置 。 但 是 ， 从 相 邻 模块 通 
过 深度 优先 搜索 ， 模 块 们 可 以 检测 到 它们 是 否 会 与 
结构 相 脱 离 ， 于 是 解 链 步骤 就 没有 必要 了 。 运 动 中 ， 
当 其 他 模块 开始 移动 时 必须 小 心 以 确保 路 径 仍 然 有 
效 。 这 可 以 通过 序列 化 或 者 局 部 的 交通 控制 方 
案 呈 2 来 实现 ， 即 模块 彼此 通信 并 轮流 通过 一 个 特 
定 的 区 域 。 可 以 证 明 形 状 重 构 算 法 需要 个 模块 进 
fi O(n’) 次 模块 运动 ， 但 是 通常 如 果 运 动 是 并 行 执 
行 的 话 ， 则 只 需要 O(n) 次 运动 。 


并 只 有 该 种 模块 能 够 响应 特定 的 请 求 。Fiteh 等 
人 ”提出 了 一 种 规划 系统 用 于 尺寸 相似 但 是 类 
别 过 蜡 的 模块 ， 首 先 不 考虑 模块 类 别 而 获得 正确 
的 形状 ， 然 后 模块 交换 位 置 。 在 大 多 数 情况 下 这 
种 算法 仍然 只 需要 O(n?) 次 运动 ， 并 可 用 分 布 式 
方式 有 效 执行 。 


39.3.3 构 型 优化 


确定 合适 的 构 型 是 手动 重 构 和 自动 重 构 系 统 中 的 
另 一 个 关键 问题 ， 但 是 在 文献 中 很 少 提 及 。 一 种 常用 
的 途径 是 经 验方 法 一 一 模拟 不 同 构造 下 特定 的 任务 或 
者 一 系列 任务 (例如 一 个 装配 过 程 )， 并 比较 每 种 情 
况 下 的 效率 。 例 如 ， 在 RMMS 系统 的 描述 中 ， 参 考 
文献 [39. 22] 提 到 对 特定 的 机 器 人 操纵 任务 ， 有 模 
拟 器 可 以 确定 最 适合 的 构 型 。 针 对 CEBOT 系统 也 有 
类 似 的 研究 ， 对 机 械 手 的 位 置 和 所 需要 的 模块 数量 以 
及 模块 的 构 型 进行 了 优化 3。 在 关于 二 进 制 机 械 
手 的 研究 中 ， 针 对 给 定 的 一 系列 需要 到 达 的 点 ， 找 出 
优化 的 构 型 ， 在 这 其 中 利用 了 拉 格 朗 日 乘 子 来 最 小 化 
从 基本 结构 转换 至 可 以 取得 期 望 位置 的 结构 带 来 的 
App 1. 

在 自我 重 构 机 器 人 系统 中 ， 多 达 上 百 个 模块 任意 
放置 ， 因 此 有 相当 多 的 构 型 需要 考虑 ， 而 任务 本 身 可 
比 这 更 加 复杂 。 第 61 章 描述 了 优化 模块 化 机 器 人 构 
型 的 一 种 革命 性 方法 (虽然 不 是 自我 重 构 )。 来 自 多 
机 器 人 队伍 的 更 通用 的 构 型 优化 方法 可 应 用 于 监控 等 
任务 ， 虽 然 它 们 需要 进行 修改 以 处 理 自我 重 构 系 统 的 
功能 。 


39.3.4 自我 复制 系统 


自我 复制 模块 化 机 器 人 是 一 类 消除 了 构 型 决定 问 
题 的 系统 。 在 这 类 系统 中 ， 从 供应 模块 生成 一 组 模块 
的 副本 。 自 我 复制 理论 由 冯 … 诺 伊 曼 建 立 ”” ， 然 
而 工程 上 研制 这 样 的 一 个 机 器 人 系统 是 一 个 相当 大 的 
挑战 。Suthakorn 等 人 已 经 以 有 限 的 形式 展示 了 这 种 
DE ,在 该 系统 中 机 器 人 由 四 种 很 复杂 的 模块 
所 构建 ， 一 个 机 器 人 可 以 构建 第 二 个 机 器 人 ， 类 似 
Jb, Zykov 等 人 '”” 用 更 传统 的 阵列 式 自我 重 构 模 块 
展示 了 同一 功能 。 


鲁 棒 性 模块 化 


使 用 很 多 简单 模块 来 完成 一 项 任务 在 失效 的 情况 


39. 4 


如 果 是 非 均 匀 系 统 ， 也 就 是 说 ,模块 具有 不 
同 种 类 ， 必 须要 决定 所 给 的 位 置 需 要 哪 一 种 模块 ， 


下 可 保持 鲁 棒 性 。 如 果 模 块 完全 一 致 ， 那 么 它们 可 以 
进行 简单 的 互 换 。 如 果 系 统 的 设计 具备 足够 多 的 宛 余 
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度 ， 模 块 失 效 的 时 候 系统 可 以 完全 不 受 影响 。 这 种 自 
我 维修 的 过 程 有 可 能 自动 执行 ， 正 如 有 些 自我 重 构 系 
统 所 提出 来 的 那样 ””” 。 在 这 些 情况 下 ， 通 过 有 
选择 性 的 拆卸 将 失效 模块 移 到 外 表层 ， 或 者 通过 挤 压 
步 态 移动 模块 ， 可 将 失效 模块 从 系统 中 挤 出 。Dragon 
接头 Y ”在 模块 失效 时 总 可 以 从 其 中 一 侧 脱 离 ， 于 
是 系统 能 以 最 小 的 损失 继续 工作 。 但 是 ， 尽 管 模块 系 
统 的 这 种 自我 维修 功能 很 重要 ， 但 它 还 没有 成 为 研究 
的 一 个 焦点 。 
另 一 方面 ， 手 动 重 构 的 系统 可 能 没有 能 逐 出 失效 
模块 的 选项 。 实 际 上 ， 它 们 在 建造 的 时 候 就 可 能 具 
内 在 的 元 余 度 ， 不 论 是 以 主动 还 是 被 动 的 方式 ， 都 可 
以 简单 地 处 理 失效 的 模块 。 例 如 ， 在 虚拟 车 辆 中 ， 如 
果 运 转 的 物体 相对 于 制动器 斥 十 很 大 ， 那 么 单个 部 件 
的 失效 可 能 不 会 影响 整体 性 能 。 类 似 地 ， 宛 余 机 械 手 
例如 RMMS ”在 单个 关节 被 卡 住 时 还 能 够 持续 工 
JE, 虽然 必须 主动 检测 这 种 情况 的 发 生 从 而 可 以 考虑 
到 动力 学 和 运动 学 的 改变 。 


上 由 


39.5 结论 与 扩展 阅读 
不 管 系统 是 自己 改变 构 型 还 是 需要 人 的 辅助 ， 


EE 


在 许多 不 同 的 任务 领域 都 可 以 看 到 模块 化 的 好 
] 以 利用 模块 化 来 简单 创建 更 大 型 的 机 器 ， 例 如 ， 
可 以 实现 更 强 的 运动 ,或 者 更 复杂 的 机 器 但 是 在 
模块 层次 仍然 很 简单 。 现 在 ,在 研究 领域 硬件 系 
统 很 大 程度 上 没 怎么 变化 ， 然 而 在 数 个 领域 中 算 
法 进展 更 显著 ,例如 自我 重 构 。 人 们 希望 在 大 规 
模 生产 的 同时 可 以 降低 模块 化 机 器 人 研发 的 相关 
成 本 ,使 得 这 种 系统 内 在 的 鲁 棒 性 和 多 用 性 可 以 
得 到 更 多 的 应 用 。 

感 兴趣 的 读者 可 以 在 一 篇 调查 报告 ”中 找到 
自我 重 构 机 器 人 的 更 多 细节 ， 这 个 领域 内 的 专题 讨论 
会 也 经 常 与 国际 会 议 一 起 举行 ， 例 如 2006 年 机 器 人 : 
科学 与 系统 会 议 ， 和 2007 年 国际 智能 机 器 人 与 系统 
会 议 。 分 布 式 机 器 人 系统 一 般 是 每 两 年 举办 一 次 的 分 
布 式 自 动机 器 人 系统 (DARS) 会 议 的 主题 内 容 ,， 包 
括 许多 与 该 主体 相关 的 文章 。 


H 


H 
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伍 小 军 详 
在 多 移动 机 器 人 系统 背景 下 。 林 这 研 究 其 当前 。。 40.2 多 机 器 人 系统 的 体系 结构 ……………… 382 
的 技术 发 展 水 平 。 在 简要 介绍 之 后 ， 我 们 首先 考察 40.2.1 Nerd Herd 系统 eee. 382 
多 机 器 人 协作 的 体系 结构 ， 并 探究 已 经 开发 的 蔡 代 40. AAELTANGE Rec Igiene 383 
方案 。 接 下 来 ， 在 第 40.3 节 ， 我 们 研究 通信 问题 40.2.3. PRANA RAE 384 
和 他 们 对 多 机 器 人 队伍 的 影响 ， 紧 接 着 在 第 40.4 40.3 通信 和 384 
节 我 们 讨论 群体 机 器 人 系统 。 群 体 机 器 人 系统 通常 40.4 群体 机 器 人 whos anasto canes meee dae eee eae 385 
假设 很 多 个 无 差别 的 机 器 人 ， 其 他 类 型 的 多 机 器 人 40.5 不 均匀 系统 eee 386 
系统 包括 不 同 的 机 嚣 人。 因此 接 下 来 我 们 在 第 40.6 ”任务 分 配 HH 388 
40. 5 节 讨论 协作 机 器 人 队伍 中 的 非 均 匀 性 。 一 旦 40.6.1 任务 分 配 的 分 关系 统 eene 388 
机 器 人 队伍 允许 单个 机 器 人 的 非 均 匀 性 ， 任务 分 配 40. 6.2 ”代表 性 方法 e MM 388 
等 问题 便 变 得 重要 ， 因此 在 第 40.6 节 讨 论 常见 的 40.7 学习 389 
任务 分 配方 法 。 第 40.7 节 讨 论 多 机 器 人 学 习 的 挑 40. 8 RU -- nated NUDO nS e RU eR e S aca RR RUN V mak ER dn 390 
战 ， 和 一 些 代表 性 的 方法 。 在 第 40. 8 节 我 们 概述 40.8.1 Wi mx eee 390 
一 些 典 型 的 应 用 领域 ， 作 为 多 机 器 人 系统 研究 的 测 40.8.2 群集 与 成 形 MM 390 
试 平台 。 最 后 ， 在 第 40.9 45, 我们 对 本 章 做 出 结 40.8.3 TERT SPRATA nme 391 
it, 包括 一 些 总 结 性 的 评论 ， 并 给 读者 一 些 进一步 40.8.4 多 目标 观测 pp 391 
阅读 的 建议 。 40.8.5 ”交通 控制 和 多 机 器 人 路 径 规划 ……… 391 
40.8.6 机 器 人 足球 赛 M 392 
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研究 者 们 一 般 都 同意 多 机 器 人 系统 相对 于 单机 器 
人 系统 有 几 个 好 处 “1 。 发 展 多 机 器 人 系统 解决 方 
案 最 常见 的 动机 是 : 

1) 任务 复杂 度 太 高 以 至 于 单个 机 器 人 完成 
TA. 

2) 任务 具有 内 在 的 分 布 式 属性 。 

3) 建造 几 个 资源 受 限 型 机 器 人 比 单个 功能 强大 


的 机 器 人 容易 得 多 。 
4) 利用 平行 算法 ， 多 机 器 人 能 够 更 快 解决 


5) 引入 多 机 器 人 系统 通过 宛 余 度 增加 鲁 棒 性 。 

开发 多 机 器 人 解决 方案 必须 要 面 对 的 问题 取 
决 于 任务 的 需求 ， 机 器 人 传感器 和 来 端 执 行 器 的 
功能 。 

多 移动 机 器 人 系统 的 研究 中 考虑 的 是 那些 在 环境 
中 四 处 移动 的 机 器 人 类 型 ， 例 如 陆 上 和 车辆 、 飞 行 需 、 


或 者 水 下 运载 工具 。 区 别 于 其 他 类 别 的 多 机 器 人 交 
互 ， 本 章 特别 聚焦 于 多 个 移动 机 器 人 的 交互 。 例 如 ， 
多 移动 机 器 人 系统 的 一 个 特别 范例 是 为 了 导航 或 者 操 
纵 的 目的 而 互 连 的 重 构 或 模块 化 机 器 人 。 第 39 章 详 
细 讲 述 了 这 种 多 机 器 人 系统 。 第 41 章 讲述 的 网 络 机 
器 人 也 与 多 移动 机 器 人 系统 紧密 相关 ; 但 是 ， 网 络 机 
器 人 的 重点 是 通过 网 络 通信 彼此 连接 的 机 器 人 、 传 感 
器 、 舱 入 式 计算 机 和 用 户 等 的 系统 。 男 外 一 个 多 机 器 
人 协作 的 变 体 是 多 个 机 械 手 的 合作 ; 第 29 章 详细 描 
述 了 这 种 系统 。 


jl 


40.1 背景 


p! 


自从 20 世纪 80 年 代 最 早 有 关 多 移动 机 器 人 系统 
的 研究 以 后 ， 该 领域 已 经 显著 成 长 ， 涵 盖 了 大 量 的 研 
究 成 果 。 在 最 一 般 的 层次 ， 多 移动 机 器 人 系统 分 为 两 
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大 类 : 协同 集群 系统 和 主动 协作 系统 。 在 协同 集群 系 
统 中 ， 机 器 人 执行 各 自 的 任务 而 很 少 需要 知道 其 他 机 
器 人 同伴 的 情况 。 这 些 系统 的 特征 是 假设 有 很 多 无 差 
别 移动 机 器 人 ， 每 个 机 器 人 利用 本 地 控制 法 则 来 产生 
全 局 连贯 的 团队 行为 。 另 一 方面 ， 主 动 协作 系统 中 的 
机 器 人 知道 环境 中 其 他 机 器 人 的 存在 ， 并 基于 团队 成 
员 的 状态 、 行 为 或 者 功能 来 一 起 行动 以 完成 同一 个 目 
标 。 主 动 协 作 系 统 机 器 人 考虑 其 他 机 器 人 的 行为 或 状 
态 的 程度 不 一 样 ， 可 导致 强 或 者 弱 的 协作 方案 。 
强 协作 方案 执行 不 容易 串 行 化 的 任务 ， 要 求 机 器 人 共 
同行 动 以 完成 目标 。 这 些 方 法 要 求 机 器 人 之 间 的 某 种 
通信 和 同步 。 弱 协作 方案 在 协调 机 器 人 任务 和 角色 选 
择 之 后 允许 机 器 人 有 独立 运行 的 时 间 。 主 动 协作 多 机 
器 人 系统 能 够 处 理 机 器 人 队伍 成 员 的 差异 性 ， 例 如 传 
感 器 和 执行 器 的 功能 不 一 样 。 在 这 些 系统 中 ， 机 融 人 
的 协同 与 协同 集群 机 器 人 的 方法 很 不 一 样 ， 因 为 机 器 
人 之 间 不 再 是 可 互 换 的 。 

大 多 数 针对 多 移动 机 器 人 协作 的 研究 可 以 分 为 一 
系列 关键 研究 主题 。 这 些 主题 ， 也 是 本 章 讨论 的 重 
点 ， 包 括 系统 结构 ， 通 信 ， 群 体 机 器 人 ， 非 均匀 性 ， 


这 在 理论 上 是 可 能 的 ,但 是 ， 由 于 对 单个 失效 
点 很 脆弱 ， 并 且 以 适合 实时 控制 的 频率 将 整个 系统 
的 状态 传 回 中 央 人 处 理 单元 的 难度 很 高 ， 该 结构 通常 
在 实际 使 用 中 并 不 切实 际 。 在 与 此 类 结构 有 关 的 应 
用 中 ， 从 中 央 控 制 器 可 以 很 方便 地 观察 各 机 咒 人 ， 
并 能 够 很 容易 地 广播 群 组 消息 供 所 有 机 器 人 
遵循 。 

分 层 式 系统 结构 对 某 些 应 用 是 实用 的 。 在 这 种 控 
制 方法 中 ， 每 一 个 机 器 人 监督 相对 较 少 的 一 组 机 器 人 
的 行动 ， 而 该 组 中 的 每 一 个 机 器 人 又 依次 监督 另外 的 
一 组 机 器 人 ， 以 此 类 推 ， 直 至 仅仅 只 执行 本 身 任务 的 
最 底层 的 机 器 人 。 这 种 结构 比 集中 式 方法 能 更 好 地 缩 
放 ， 类 似 于 军事 上 的 命令 与 控制 。 分 层 式 控制 体系 结 
构 的 一 个 局 限 是 当 控 制 树 中 处 于 高 层 的 机 器 人 失效 
时 ， 复 原 很 困难 。 

分 布 式 控制 体系 结构 是 多 机 器 人 队伍 最 常用 的 方 
法 ,通常 只 需要 机 器 人 基于 对 本 地 情况 的 了 解 来 采取 
行动 。 这 种 控制 方法 对 失效 有 高 度 的 鲁 棒 性 ， 因 为 机 
顷 人 不 需要 负责 控制 男 外 的 机 器 人 。 但 是 ， 要 在 这 些 
系统 中 获得 全 局 一 致 性 很 困难 ， 因 为 高 层 的 目标 必须 


任务 分 配 和 学 习 。 多 机 器 人 系统 中 的 系统 结构 和 通信 
与 所 有 多 机 器 人 系统 类 型 相关 ， 因 为 这 些 方法 规定 了 
机 器 人 团队 中 的 成 员 如 何 组 织 和 交互 。 群 体 机 器 人 是 
一 种 特殊 类 型 的 多 机 器 人 系统 ， 其 特征 是 很 多 个 无 差 
别 机 器 人 内 在 彼此 互动 。 这 样 的 系统 经 常用 来 与 非 均 
匀 机 器 人 做 对 比 ， 后 者 队伍 成 员 的 功能 可 以 显著 不 
同 。 当 机 器 人 的 功能 不 一 样 时 ， 确 定 哪些 机 器 人 应 该 
执行 哪 项 任务 变 得 很 有 挑战 一 一 该 挑战 通常 称 为 任务 
分 配 。 最 后 ， 多 机 器 人 队伍 中 的 学 习 在 设计 具备 时 间 
适应 能 力 并 能 学 习 新 行为 的 机 器 人 队伍 过 程 中 特别 受 
关注 。 通 常 可 以 通过 一 系列 代表 性 的 应 用 领域 来 说 明 
在 每 一 个 领域 中 的 进展 ; 这 些 应 用 是 本 章 最 后 讨论 的 
一 个 重点 主题 。 


40.2 多 机 器 人 系统 的 体系 结构 


为 多 机 器 人 队伍 设计 总 体 控制 体系 结构 对 于 系统 
的 鲁 棒 性 和 可 伸缩 性 有 重要 的 影响 。 多 机 器 人 队伍 的 
机 器 人 体系 结构 的 基本 组 成 部 件 与 单个 机 器 人 系统 相 
同 ， 后 者 在 第 8 章 有 描述 。 然 而 ， 多 机 器 人 系统 必须 
处 理 机 器 人 的 交互 以 及 如 何 从 队伍 中 单个 机 器 人 的 控 
制 体系 结构 来 产生 群体 的 行为 。 多 机 器 人 队伍 体系 结 
构 可 以 有 几 种 不 同 的 分 类 标准 ; 最 常见 的 是 集中 式 、 
分 层 式 、 分 布 式 和 混合 式 。 

集中 式 体 系 结构 从 单个 控制 点 来 协同 整个 队伍 ， 


要 整合 到 每 一 个 机 器 人 的 本 地 控制 。 如 果 目 标 改 变 ， 
则 很 难 修改 单个 机 器 人 的 行为 。 

混合 式 控制 体系 结构 结合 本 地 控制 与 高 层次 控制 
方法 来 获得 鲁 棒 性 和 通过 全 局 目标 、 计 划 或 控制 来 影 
响 整 个 团队 行为 的 能 力 。 许 多 多 机 器 人 控制 方法 应 用 
了 混合 式 系 统 结 构 。 

这 些 年 来 已 经 开发 了 很 多 的 多 机 器 人 控制 体系 结 
构 。 这 里 我 们 集中 描述 三 种 方法 来 说 明 控制 体系 结构 
的 整个 范围 。 第 一 种 ，Nerd Herd 方法 ， 是 使 用 多 个 
无 差别 机 器 人 的 纯 群 体 机 器 人 方法 的 代表 。 第 二 种 ， 
ALLIANCE， 是 基于 行为 方法 的 代表 ， 能够 协同 多 机 
器 人 ， 并 且 在 没有 直接 协同 的 情况 下 仍 可 控制 非 均匀 
机 器 人 。 第 三 种 ,分 布 式 机 器 人 体系 结构 (DIRA), 
是 一 种 混合 式 方法 ,可 在 非 均 匀 机 器 人 队伍 中 取得 机 
器 人 自动 化 和 直接 协同 。 


40.2.1 Nerd Herd 系统 


Mataric 进行 了 最 早 的 多 机 器 人 社会 行为 的 研究 
ZO! SAI FA HL 20 个 相似 机 器 人 组 成 的 Nerd 
Herd 团队 演示 其 结果 (LES 40. 1) 。 这 项 工作 是 群体 
机 器 人 系统 的 一 个 范例 ， 第 40.4 节 将 进一步 讲述 。 
分 布 式 控制 方法 基于 包容 体系 (参考 第 8 章 ) ， 并 假 
设 所 有 的 机 器 人 都 是 无 差别 的 ， 但 是 单个 机 器 人 只 具 
备 相 对 简单 的 功能 ， 例 如 探测 障碍 物 和 同伴 ( 即 其 
他 机 器 人 成 员 ) ， 并 定义 和 证 明了 一 系列 基本 的 社会 
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行为 (参考 第 38 章 )， 
分 散 、 跟 随和 安全 漫游 。 


式 组 合 可 产生 更 复杂 的 社会 
分 散 组 成 ) ， 


全 漫游 、 聚 合 、 


包括 避 障 、 返 回 原 地 、 聚 合 、 
这 些 基本 行为 通过 不 同 的 方 
行为 ， 包 括 群 集 (由 安 
包围 (由 安全 漫游 、 跟 


随和 聚合 组 成 ) , 


集中 (H 


日 安全 漫游 、 包 围 和 群集 组 


分 散 、 跟 随 、 返 


回 原 地 和 


A), WE (由 安全 漫游 、 
群集 组 成 )。 这 些 行为 通过 
合法 则 : 
聚合 : 
WE “机 器 人 单元 位 于 聚合 
转向 聚合 中 心 点 前 进 


法 则 来 实施 ， 例 如 下 述 聚 


范围 之 外 


其 他 
停止 
这 项 研究 表明 集体 行为 可 通过 组 合 低 阶 的 基本 行 
为 来 产生 。 该 项 目 还 研究 了 用 桶 链 算 法 来 减少 干 
gen . 


zi 


VA BABA M 


图 40.1 Nerd Herd 机 器 人 


40.2.2 ALLIANCE 体系 结构 


另外 一 项 早期 的 多 机 器 人 体系 结构 人 研究 是 同盟 
(ALLIANCE) 体系 (JL 40.2), ， 由 Parker ^? 设计 
用 于 不 均匀 多 机 器 人 队伍 的 可 容错 任务 分 配 。 该 方法 
建立 在 包容 体系 之 上 ， 增 加 了 行为 集合 和 动机 ， 在 机 
器 人 之 间 没 有 直接 协商 的 情况 下 取得 行动 选择 。 行 为 
集合 将 低 阶 的 行为 组 合 到 一 起 以 执行 特定 的 任务 。 动 
机 由 不 同 级 别 的 焦躁 和 默许 组 成 ， 可 以 增加 或 者 降低 
机 器 人 针对 某 项 必须 完成 的 任务 时 激活 某 行为 集合 的 


同盟 


图 40.2 ALLIANCE 体系 结构 


2) 焦躁 率 。 

3) 传感器 反馈 是 否 表明 需要 行为 集合 

P ee dy ;外 一 个 行为 集合 。 

5) 是 否 有 男 外 一 个 机 器 人 已 经 开始 为 该 任务 
工作 。 

6) 基于 已 
愿意 放弃 该 任务 。 

动机 以 某 一 正 速 率 持续 增加 ， 除 非 下 面 四 种 情况 
之 一 发 生 : 

1) 传感器 反馈 显 
FEA 


2) 激活 了 机 器 人 中 另外 一 个 行为 集合 。 

3) 其 他 机 器 人 第 一 次 接手 了 任务 。 

4) 机 器 人 决定 默许 该 任务 。 

在 上 述 的 任何 一 种 情况 下 ， 动 机 返回 零 。 和 否则 ， 
a e anne 

， 可 以 确定 机 器 人 选 定 了 一 种 行为 。 当 一 种 行为 被 
选 定 ， 该 机 器 人 内 部 的 交叉 抑制 将 防止 其 他 任务 在 同 
一 机 器 人 内 激活 。 当 某 个 行为 集合 在 机 器 人 内 处 于 激 
活 状态 ， 该 机 器 人 每 隔 一 段 时 间 将 它 的 当前 行为 广播 
给 其 他 机 器 人 。 

L- ALLIANCE 扩展 外 中 允许 机 器 人 根据 它 完 
某 项 给 定 任务 的 期 望 质量 来 调整 焦躁 和 默许 的 比率 。 
结果 是 已 经 证 明 能 更 好 完成 某 些 任务 的 机 器 人 将 来 
也 更 有 可 能 选择 同样 的 任务 。 另 外 ， 如 果 机 器 人 队 


笃 尝试 任务 的 时 间 长 短 ， 机 器 人 是 


fis TH 


REA ^E fn] fat , 


机 器 人 可 以 动态 重新 分 配 它们 


M. 
3. 


为 零 。 


在 这 种 方法 中 ， 


计算 动机 的 水 准 : 
1) 前 一 步 的 动机 水 准 。 


然后 ， 在 每 一 


执行 给 定 行为 集合 的 初始 动机 设 
个 时 间 步 又 ， 根 据 以 下 因素 重新 


的 任务 来 弥补 问题 。 为 验证 这 种 方法 ， 


分 别 测试 了 


由 三 个 非 均 匀 机 顺 人 组 成 的 机 器 人 队伍 来 执行 一 项 


模拟 的 清扫 任务 ， 两 个 机 器 人 执行 的 推 箱 


子 任务 ， 


以 及 四 个 机 器 人 执行 的 协同 目标 观测 问题 。 该 方法 
也 在 模拟 看 门 服务 任务 以 及 掩护 跃进 中 得 到 了 验证 。 
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图 40. 3 给 出 了 多 机 器 人 利用 ALLIANCE 执行 模拟 的 
清扫 任务 。 


图 40.3 多 机 器 人 利用 ALLIANCE 执行 
模拟 的 清扫 任务 


40.2.3 分 布 式 机 器 人 系统 结构 


Simmons 等 人 忆 呈 开发 了 一 种 混合 体系 结构 ， 称 
为 分 布 式 机 器 人 体系 结构 (DIRA) 。 与 Nerd Herd 和 
ALLIANCE 方法 类 似 ，DIRA 方法 允许 单个 机 器 人 的 
自主 权 。 但 是 , 不 像 前 述 方法 ，DIRA 有 利于 机 器 人 
之 间 的 直接 协同 。 这 种 方法 基于 分 层 体系 结构 ， 后 者 
在 单机 器 人 系统 中 很 流行 (参见 第 8 章 ) 。 在 这 种 方 
法 中 ( 见 图 40.4)， 每 一 个 机 器 人 的 控制 体系 包括 一 
个 规划 层 来 决定 如 何 取得 高 阶 的 目标 ;一 个 执行 层 用 
于 同步 各 单元 ， 任 务 序列 ， 并 监控 任务 的 执行 ; 一 个 
行为 层 ， 与 机 器 人 的 传感器 和 致 动 器 交互 。 上 述 每 一 
层 又 分 别 与 其 上 下 的 层 相交 互 。 并 且 ， 在 每 一 层 机 器 
人 能 够 通过 直接 连接 彼此 交互 。 


机 器 人 3 


图 40.4 分 布 式 机 器 人 体系 结构 


这 种 体系 结构 已 经 在 由 三 个 机 器 人 组 成 的 机 器 
人 队伍 中 得 到 证 明 一 一 一 辆 起 重 机 ， 一 辆 摄像 流动 
车 ,一 个 可 移动 机 械 手 一 一 执行 一 项 结构 装配 任务 


( 见 图 40. 5) 。 这 项 任务 需要 机 器 人 协作 将 一 道 横梁 
连接 到 指定 位 置 。 在 这 些 示 范 中 ， 一 个 领班 机 融 人 
决定 哪 一 个 机 器 人 应 该 在 何 时 移动 横梁 。 一 开始 ， 
起 重 机 机 器 人 基于 编码 器 反馈 将 横梁 移动 到 目标 位 
置 的 附近 。 然 后 ， 领 班机 器 人 在 摄像 流动 车 和 起 重 
机 之 间 设 置 一 个 行为 闭环 ， 以 将 横梁 伺服 到 更 靠近 
目标 位 置 点 。 一 旦 横梁 足够 靠近 ， 领 班机 絮 人 随后 
分 配 任务 给 摄像 流动 车 和 移动 机 械 手 ， 驱 动机 械 手 
抓 住 横梁 。 开 始 接触 后 ， 领 班机 器 人 指挥 摄像 流动 
车 和 移动 机 械 手 相互 协调 驱动 横梁 到 达 目 标 ， 任 务 


完成 。 


图 40.5 机 器 人 利用 分 布 式 机 器 人 
体系 结构 执行 装配 任务 


40.3 通信 

在 多 机 器 人 系统 研究 中 有 一 个 基本 假设 ， 即 使 机 
器 人 缺乏 完整 的 全 局 信息 ， 通 过 机 器 人 之 间 的 交互 也 
可 以 获得 全 局 连续 的 有 效 解 。 但 是 ， 要 获得 这 些 全 局 
连续 解 需要 机 器 人 获取 有 关 同 伴 的 状态 或 者 行动 信 
息 。 该 信息 可 通过 很 多 方法 获得 ， 三 种 最 常见 的 方 


1) 利用 环境 中 的 内 在 通信 ( 称 为 间接 通信 ) , 
机 器 人 通过 对 环境 的 作用 来 感知 同伴 的 行动 效果 
(例如 参考 文献 【40.6，12-16] ) 。 

2) 被 动 行为 识别 ， 机 器 人 利用 传感器 来 直接 观 
测 同伴 的 行动 (例如 参考 文献 [40. 17] ) 。 

3) fst (有 目的 的 ) 通信 ， 机 器 人 通过 某 些 主 
动 方式 ,例如 无 线 电 (例如 参考 文献 [40.9，18- 
20]) ， 有 目的 地 直接 交流 相关 信息 。 

上 述 每 一 种 在 机 器 人 之 间 交 换 信息 的 机 制 各 有 利 
pelon 。 间 接 通信 方法 的 吸引 力 在 于 它 很 简洁 ， 不 依 
赖 于 固定 的 信道 和 协议 。 但 是 ， 它 受 限 制 于 机 器 人 的 
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环境 感知 反映 任务 显著 状态 的 程度 ， 该 任务 是 机 器 人 
队伍 必须 要 完成 的 。 被 动 式 行为 识别 的 吸引 力 在 于 它 
不 依赖 于 有 限 的 带宽 和 容易 出 错 的 通信 机 制 。 在 内 在 
协同 方面 ， 它 受 限于 机 器 人 成 功 理解 传感器 信息 的 程 
度 ， 以 及 分 析 机 器 人 同伴 行动 的 难度 。 最 后 ， 显 示 通 
信 方 法 的 吸引 力 在 于 机 器 人 能 够 直接 和 容易 地 意识 到 


40.4 群体 机 器 人 


历史 上 部 分 最 早 的 多 机 器 人 系统 研究 ”3 
针对 的 是 大 量 无 差别 机 器 人 ， 称 为 群体 机 器 人 。 时 
至 今日 这 仍然 是 一 个 活跃 领域 ， 群 方法 从 生物 领域 


同伴 的 行动 和 /或 目标 。 显 式 通 信 在 多 机 器 人 中 主要 
用 来 对 通信 进行 协同 ， 交 换 信息 ， 以 及 机 器 人 之 间 的 
协商 。 显 式 通信 可 用 来 处 理 隐藏 状态 问题 ，” ， 有 
限 的 传感器 不 能 区 分 环境 的 不 同 状态 ， 而 这 些 状态 对 
于 任务 性 能 极为 重要 。 但 是 ， 显 式 通信 的 故障 包容 度 
MORAR, AE a K Rs Bi A 
限 的 信道 ， 而 不 能 持续 地 连接 机 器 人 队伍 中 的 所 有 成 
员 。 因 此 ， 使 用 显 式 通 信 的 方法 必须 提供 处 理 通 信 失 
效 与 消息 丢失 的 机 制 。 

设计 阶段 在 多 机 器 人 队伍 中 选择 合适 的 通信 ， 
取决 于 多 机 器 人 队伍 所 要 完成 的 任务 。 需 要 仔细 考 
虑 替代 通信 方案 的 成 本 和 好 处 ,来 决定 能 够 可 靠 获 
得 所 需 系 统 性 能 的 方法 。 研 究 者 一 般 同 意 通信 能 
对 团队 性 能 产生 很 强 的 正面 影响 。MacLennan 的 工 
作 '*” 引 是 最 早 说 明 该 影响 的 研究 之 一 ， 他 研究 了 通 
信 在 模拟 环境 中 的 进化 ， 并 得 出 结论 ， 本 地 机 器 人 
信息 的 通信 能 产生 极 大 的 性 能 提高 。 有 趣 的 是 ， 对 
于 很 多 代表 性 的 应 用 ， 研 究 者 们 发 现 通信 信息 量 扣 
它 对 机 器 人 队伍 的 影响 之 间 存 在 非 线性 关系 。Balcjh 
和 Arkin 的 研究 “并 证 实 ， 通常 ， 即 便 是 很 小 的 信 
息 量 都 能 对 队伍 产生 重大 的 影响 。 但 是 ， 更 多 的 信 
息 并 不 一 定 会 持续 提高 性 能 ， 因 为 这 会 很 快 使 通信 
带宽 过 载 而 产生 不 了 应 用 好 处 。 多 机 器 人 系统 的 挑 
战 在 于 找 出 能 提高 性 能 但 又 不 会 使 通信 带宽 饱和 的 
最 优 信 息 片 段 用 于 交换 。 当 前 ， 没 有 通用 方法 能 识 
别 这 些 关键 的 信息 是 否 可 用 ; 因此 ， 系 统 设 计 者 需 
要 根据 具体 的 应 用 来 决定 哪些 信息 需要 通信 。Dudek 
的 多 机 器 人 分 类 系统 包括 与 通信 相关 的 轴线 ， 内 容 
包含 通信 范围 ， 通 信 拓 扑 和 通信 带宽 。 这 些 特征 可 
用 来 比较 和 对 照 多 机 器 人 系统 。 

在 多 机 器 人 队伍 通信 的 活跃 研究 中 有 几 项 是 关于 
动态 网 络 连接 和 拓扑 ; PAO, PLAS A DEE SE 
移动 中 保持 通信 连接 ， 或 者 利用 恢复 战略 使 机 器 人 队 
伍 在 通信 连接 中 断 的 时 候 复原 。 这 些 问 题 要 求 机 器 人 
根据 对 通信 网 络 的 预期 效果 或 者 对 信息 通过 动态 网 络 
的 预期 传播 行为 的 了 解 来 相应 调整 行动 。 上 述 以 及 相 
关 的 问题 在 网 络 机 器 人 的 范畴 内 有 更 详细 的 讨论 ; 更 
多 信息 参见 第 41 章 。 


X 


得 到 启发 一 一 特别 是 蚂蚁 ,蜜蜂 和 乌 类 一 一 并 在 多 
机 需 人 队伍 中 开发 相似 的 行为 。 因 为 生物 性 领域 能 
够 实现 印象 深刻 的 群体 能 力 ， 例 如 白蚁 类 能 建造 大 
而 复杂 的 土 堆 ， 或 者 蚂蚁 能 够 协作 搬 动 大 个 猎物 ， 
机 器 人 研究 者 以 在 机 器 人 领域 复制 这 样 的 能 力 为 
目标 。 

群体 机 器 人 系统 通常 称 作 协作 机 器 人 ， 意 味 着 
单个 机 器 人 通常 除了 其 周围 信息 外 并 不 能 意识 到 系 
统 中 其 他 机 器 人 的 行动 。 这 些 方法 的 目标 是 从 单个 
机 需 人 的 交互 动力 学 取得 所 期 望 的 团队 层次 的 全 局 
行为 ， 而 单个 机 器 人 遵守 相对 简单 的 本 地 控制 法 则 。 
群 机 器 人 系统 通常 包含 很 少 的 机 器 人 之 间 的 显 式 通 
言 ， 而 是 依赖 于 间接 通信 ( 即 通 过 环境 的 通信 ) 来 
取得 偶发 的 协作 。 假 定单 个 机 器 人 拥有 最 低 限 度 的 
功能 ， 因 此 凭 自身 完成 有 意义 的 实际 任务 的 能 力 很 
低 。 但是， 与 其 他 类 似 的 机 器 人 组 合 到 一 起 后 ， 它 
们 能 够 协作 完成 团队 层次 的 任务 。 理 想 情 况 下 ， 整 
个 团队 能 比 机 器 人 单独 工作 取得 更 多 成 效 ( 即 ， 超 
加 性 ， 意 味 着 总 体 大 于 单个 部 分 的 简单 相 加 ) 。 这 
些 系统 假设 大 量 的 机 器 人 (至 少数 打 ， 通 常 成 百 或 
EF) 并 直接 处 理 扩展 性 。 群 体 机 器 人 方法 拥有 高 
层次 的 宛 余 度 ， 因 为 机 器 人 彼此 类 似 ， 因 此 可 以 
互 换 。 

人 们 研究 了 许多 类 型 的 群 行为 ， 例 如 更 食 、 和 群 
集 、 链 接 、 搜 索 、 聚 居 、 聚 合 和 包容 。 这 些 群 行为 主 
要 涉及 空间 分 布 的 多 机 器 人 运动 ， 要 求 机 器 人 通过 以 
下 方式 协调 运动 。 

1) 相对 于 其 他 机 器 人 。 

2) 相对 于 环境 。 

3) 相对 于 外 部 机 器 人 。 

4) 相对 于 机 器 人 以 及 环境 。 

5) 相对 于 所 有 项 目 〈 即 其 他 机 器 人 、 外 部 机 器 
人 和 环境 ) 。 

KR 40. 1 根据 这 些 组 别 对 群体 机 器 人 进行 归 类 ， 
并 列举 了 代表 性 的 相关 研究 范例 。 

当前 很 多 群体 机 器 人 的 研究 目标 是 为 表 40. 1 中 
一 种 或 者 数 种 群 行为 开发 特定 的 方案 。 某 些 群 行为 受 
到 了 特别 的 关注 ， 特 别 是 成 形 、 群 集 、 搜 索 、 和 覆盖 和 
WE. 5840.8 节 将 更 详细 地 讨论 这 些 行为 。 总 体 上 ， 
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移动 式 和 分 布 式 机 器 人 技术 


当前 大 多 数 开 发 群 行为 的 研究 目标 不 仅 是 证 明 与 生物 
系统 类 似 的 机 器 人 队伍 的 运动 ， 也 是 要 理解 正式 的 控 
制 理论 原理 ， 从 而 能 以 可 预测 的 方式 收敛 至 期 望 的 队 
伍 行为 ， 并 保持 在 稳定 状态 。 


表 40.1 群体 机 器 人 行为 归 类 


相对 运动 要 求 WR 行为 


成 形 [4034.35] 、 和 群集 [4.29] 、 自 
然 聚 居 ( 类似 牲畜 聚居 ) 、 教 学 、 
HELON plo. AA, 
聚合 [40.36] 、 分 散 [40.37] 


JR 8I. MANHS. y, 
Mak, BR yO] gp apto, 
定 位 [0.4] 、 地 图 绘 dj [40.43] : 


探测 cm 4 


相对 于 其 他 机 器 人 


相对 于 环境 


追捕 fs] 、 饵 诱 砚 食 [40461 、 


目标 追踪 21、 强制 畜牧 / 牧 养 


相对 于 外 部 机 器 人 


(类 似 于 羊 群 牧 养 ) 
相对 于 其 他 机 器 人 包容 、 转 圈 、 包 围 、 周 边 
和 环境 fy Sy (40. 48) 
相对 于 其 他 机 器 人 、 入 侵 、 战 略 性 掩护 、 机 器 人 
外 部 机 器 人 和 环境 pgs] 


验证 物理 群体 机 器 人 在 硬件 和 软件 方面 都 是 挑 
战 。 正 如 第 40.2 节 所 讨论 的 ，Mataric 第 一 个 完成 了 
这 种 验证 中 ,涉及 大 约 20 个 物理 机 器 人 ， 执 行 聚 
合 、 扩 散 和 和 群集。 该 研究 将 可 合成 的 基本 行为 定义 为 
构建 更 复杂 系统 的 基本 元 素 (更 多 信息 可 参见 第 38 
章 ) BELLE, McLlurkin 开发 了 一 种 扩展 的 群 
行为 软件 目录 ， 并 在 iRobot 研发 的 大 约 100 个 物理 机 
AA (PKA SwarmBot 机 器 人 ) 上 演示 了 这 些 行为 ， 
如 图 40.6 所 示 。 他 创建 了 几 种 群 组 行为 ， 例 如 躲 开 
多 个 机 器 人 、 从 源头 分 散 、 从 分 支 散 开 、 均 匀 散 开 、 
计算 平均 方位 、 跟 随 头 领 机 器 人 、 组 围绕 、 梯 度 导 
Mi, WAS. ANZA, H108 个 机 器 人 组 成 的 群 利用 
开发 的 扩散 算法 ， 在 一 个 面积 大 约 300m 的 空 校舍 里 
能 够 定位 感 兴趣 的 物体 ， 并 将 人 领 到 该 物体 的 
from 

欧盟 已 经 赞助 了 数 个 群体 机 器 人 项 目 ， 单 个 
机 右 人 的 尺寸 朝 着 逐渐 变 小 的 方向 发 展 。 例 如 ,， 工 
SWARM 项 目的 目标 是 开发 毫米 级 别 机 器 人 ， 具 备 
车 载 感 知 ， 通 信和 供电 单元 ， 执 行 受 生物 启发 的 
群 行为 以 及 协同 感知 任务 。 该 项 目 在 硬件 和 软件 


图 40.6 SwarmBot 机 器 人 


领域 都 具 挑战 ， 要 开发 全 自动 微 太 度 机 器 人 执行 
有 意义 的 协同 行为 ， 还 需要 当前 技术 水 平 有 重大 
的 进展 。 

群体 机 器 人 研究 中 另外 一 项 显著 的 工作 是 由 美国 
宾夕法尼亚 大 学 领导 ， 多 所 大 学 参与 的 SWARMS 18 
议 项 目 。 该 项 目 人 研究 的 目标 是 开发 新 的 群 系统 理论 框 
架 ， 开 发 群 模型 和 群 行为 模型 ， 分 析 群 信息 、 稳 定性 
和 和 鲁 棒 性 ， 为 主动 感知 和 覆盖 合成 突 发 性 的 行为 开发 
分 布 式 定 位 算法 。 
除了 在 硬件 上 需要 处 理 数 目 众 多 的 小 型 机 器 人 ， 
还 有 很 多 重要 的 软件 方面 的 挑战 待 解决 。 从 实际 角度 
看 ， 通 常 创建 无 差别 多 机 器 人 和 群 的 途径 是 假定 一 个 可 
能 的 本 地 控制 法 则 (或 多 个 法 则 ) ， 然 后 研究 导致 的 
群 组 行为 ,循环 直到 获得 理想 的 全 局 群 组 行为 。 但 
是 ， 长 期 目标 是 既 能 够 基于 已 知 的 本 地 控制 法 则 预测 
群 组 性 能 ， 又 能 够 基于 期 望 的 全 局 群 组 行为 生成 本 地 
控制 法 则 。 有 很 多 研究 者 在 针对 这 些 关 键 的 研究 挑战 
进行 着 活跃 的 研究 。 


40.5 不 均匀 系统 


机 器 人 不 均匀 性 可 定义 为 机 器 人 行为 、 形 态 、 性 
能 指标 、 斥 十 和 认 知 方面 的 多 样 化 。 在 大 多 数 大 规模 
的 多 机 器 人 系统 工作 中 ， 通 过 使 用 可 完全 互 换 的 无 差 
别 机 器 人 来 获得 平行 化 和 宛 余 度 的 好 处 ， 并 求 得 解 在 
空间 和 时 间 的 分 布 ( 即 ， 群 方法 ， 如 第 40.4 节 所 
述 ) 。 但 是 ， 某 些 大 量 机 器 人 的 复杂 应 用 可 能 要 求 同 
时 应 用 多 种 类 型 的 传感器 和 机 器 人 ， 而 单一 种 类 机 顺 
人 在 设计 上 不 能 容纳 所 有 这 些 元 素 。 有 些 机 器 人 需要 
缩 至 更 小 尺寸 ， 这 样 会 限制 其 载荷 ， 或 者 特定 需要 的 
传感器 太 贵 而 不 能 在 机 器 人 队伍 的 所 有 成 员 上 复制 。 
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另外 的 机 器 人 需要 足够 大 的 尺寸 来 承载 与 特定 应 用 相 
关 的 载荷 或 者 传感器 ， 或 者 在 有 限 的 时 间 内 导航 很 长 
的 距离 。 因 此 ， 这 些 应 用 需要 大 量 的 无 差别 机 器 人 一 
同 协作 。 

因此 在 多 机 器 人 队伍 中 开发 不 均匀 性 有 两 方面 的 
动机 : 不 均匀 性 对 特定 应 用 是 有 益 的 设计 特征 ， 或 者 
不 均匀 性 是 必需 的 。 作 为 设计 特征 ， 不 均匀 性 能 够 提 
供 经 济 上 的 好 处 ， 因 为 它 能 更 容易 地 将 不 同 功能 分 散 
到 多 个 队伍 成 员 ， 而 不 是 建造 很 多 个 整体 式 机 器 人 的 
拷贝 。 不 均匀 性 也 能 提供 工程 上 的 好 处 ， 因 为 设计 单 
个 机 器 人 来 整合 指定 应 用 的 所 有 传 感 、 计 算 和 驱动 的 
要 求 太 过 于 困难 。 在 物理 上 无 差别 的 机 器 人 队伍 中 ， 
作为 行为 专门 化 的 结果 ， 行 为 上 的 不 均匀 性 也 可 能 以 
偶发 的 形式 出 现 。 

研究 不 均匀 性 的 第 二 个 强烈 的 原因 是 它 具 有 必 
要 性 ， 因 为 在 实际 中 建立 一 支 真正 无 差别 的 机 器 人 
队伍 几乎 是 不 可 能 的 。 现 实 中 单个 机 器 人 的 设计 、 
制造 和 使 用 不 可 避免 地 使 得 多 机 器 人 系统 随时 间 朝 
不 均匀 性 偏离 。 这 一 点 为 有 经 验 的 机 器 人 研究 者 所 
证 实 ， 他 们 发 现 ， 因 为 传感器 调 校 、 校 正 等 的 不 一 
样 ， 同 一 个 机 器 人 的 几 个 拷贝 在 功能 上 可 以 很 不 一 
样 。 随 着 时 间 的 变迁 ， 在 单个 机 器 人 的 偏离 、 磨 损 
和 裂纹 等 作用 下 ， 即 便 机 器 人 之 间 很 小 的 初始 差异 
也 会 逐渐 增长 。 其 潜在 含义 是 , 为 了 有 效 地 应 用 机 
器 人 队伍 ， 我 们 必须 理解 其 多 样 性 ， 预 测 它 将 如 何 
影响 性 能 ， 使 机 器 人 能 够 适应 同伴 的 功能 差异 。 实 
际 上 ， 在 机 器 人 队伍 的 设计 阶段 就 明确 地 建立 多 样 
性 是 有 益 的 。 

在 非 均 匀 多 机 器 人 系统 中 有 很 多 研究 挑战 。 要 
取得 有 效 的 自动 控制 所 面 对 的 一 项 特别 挑战 是 当 机 
器 人 成 员 的 功能 发 生 重 番 时 ,会 影响 到 任务 分 配 或 
% fata) Ro 28 40.6 节 所 描述 的 方法 一 般 能 
够 处 理 非 均 匀 机 器 人 的 任务 分 配 。 非 均匀 系统 中 的 
另 一 个 重要 主题 是 如 何 识别 与 量化 机 器 人 队伍 中 的 
不 均匀 性 。 某 些 类 型 的 不 均匀 性 能 够 利用 Balch 所 
FE BASEL Wj) AERE RE poe (bg tt, EMI 
机 器 人 系统 中 的 大 部 分 研究 假设 机 器 人 拥有 一 种 通 
用 语言 和 对 用 语言 表示 的 符号 的 通用 理解 ; Jung 在 
参考 文献 [40.53] 中 指出 ， 开 发 一 个 对 不 同 物理 
功能 机 器 人 之 间 通 信 符 号 的 通用 理解 是 一 个 根本 性 
的 挑战 。 

如 第 40.2 节 所 述 ， 最 早 的 关于 物理 机 器 人 队伍 
不 均匀 性 的 研究 证 明之 一 是 Parker 开发 的 ALLIANCE 
RRB OO! 。 该 研究 证 明了 机 器 人 在 任务 分 配 和 执 
行 中 对 机 器 人 队伍 成 员 的 不 均匀 性 进行 补偿 的 功能 。 


Murphy 研究 了 在 部 署 有 袋 类 机 器 人 背景 下 的 不 均匀 
性 ， 即 一 个 母 机 器 人 在 诸如 搜索 和 救援 等 应 用 中 辅助 
HEN BL ARAM *! Grabowski 等 开发 了 用 于 监控 和 
侦察 的 模块 化 军用 机 器 人 '*”I， 由 可 互 换 的 传感器 
和 了 驱动 单元 组 成 ， 因 此 可 创建 不 同 的 不 均匀 队伍 。 
Simons 等 人 证 明了 用 非 均匀 机 器 人 进行 与 空间 应 用 相 
关 的 自动 装配 和 建造 所 2 Sukatme SEA! WEH T 
直升机 机 器 人 与 两 个 地 面 机 器 人 协作 进行 模仿 有 袋 类 
动物 的 负载 部 署 和 恢复 ， 协 作 定 位 和 侦查 ， 监 控 等 任 
务 ， 如 图 40.7 Stas, Parker EA 演示 了 用 于 传 
感 器 网 络 部 署 的 辅助 性 导航 ， 用 一 个 更 智能 化 的 机 顺 
人 首领 将 只 装备 了 简单 传感器 故 导 航 功能 弱 的 机 器 人 
引导 至 目标 位 置 ， 它 是 Howard A Brig s 
大 规模 演示 的 一 部 分 ， 即 用 100 个 机 器 人 执行 探查 、 
地 图 绘制 、 部 署 和 检测 。Chairmowicz “A! TE BA 
了 由 飞行 机 器 人 和 地 面 机 器 人 组 成 的 队伍 协作 在 市 区 
环境 进行 监控 应 用 。Parker 和 Tang ^ 9 开发 了 
ASyMTRe (通过 软件 重 构 自 动 合 成 多 机 器 人 任务 方 
案 ) ， 令 非 均匀 机 器 人 共享 传感器 资源 从 而 使 得 队伍 
能 够 完成 在 没有 紧密 耦合 的 传感器 共享 情况 下 不 可 能 
完成 的 任务 。 


图 40.7 由 一 台 飞 行 机 器 人 与 两 台地 面 机 器 人 组 成 的 
非 均匀 队伍 能 执行 协作 侦查 和 监控 任务 


在 非 均匀 多 机 器 人 队伍 领域 还 有 很 多 研究 问题 待 
解决 ; 例如 ， 最 优 的 队伍 设计 是 一 个 很 具 挑 战 的 问 
题 。 很 清楚 ， 在 给 定 的 应 用 中 所 要 求 的 行为 性 能 对 机 
器 人 队伍 成 员 的 物理 设计 规定 了 某 些 约束 。 但 是 ， 在 
针对 一 个 指定 的 应 用 设计 方案 时 ， 基 于 成 本 、 机 融 人 
可 用 性 、 软 件 设 计 的 容易 程度 、 机 器 人 使 用 的 灵活 性 
等 ， 也 很 清楚 地 可 以 有 多 个 选择 。 为 指定 的 应 用 设计 
一 个 最 优 的 机 融 人 队伍 需要 有 效 地 分 析 并 考虑 替代 方 
RIRE, 
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移动 式 和 分 布 式 机 器 人 技术 


40.6 任务 分 配 


在 很 多 多 机 器 人 应 用 中 ， 机 器 人 队伍 的 使 命定 义 
为 一 系列 必须 完成 的 任务 。 每 一 项 任务 通常 能 够 由 很 


够 执行 多 种 不 同 的 任务 。 在 很 多 应 用 中 ,任务 由 通用 
的 自动 规划 模块 或 者 人 类 设计 师 分 解 为 独立 的 子 任 
45091. AMETEA NIU 1, 或 者 角色 中。 独 
立 的 子 任务 或 者 角色 能 够 同时 取得 ， 而 任务 树 中 的 子 
任务 则 根据 它们 的 相互 依赖 关系 来 完成 。 一 旦 识别 了 
任务 或 者 子 任务 系列 ， 接 下 来 的 挑战 就 是 确定 机 器 人 
至 任务 (或 者 子 任务 ) 的 首选 映射 。 这 是 一 个 任务 
分 配 问 题 。 

任务 分 配 问 题 的 细节 可 在 很 多 方面 变化 ， 例 如 每 
个 任务 所 需 的 机 器 人 数 ， 单 个 机 器 人 同时 能 够 执行 的 
任务 数 ， 任 务 之 间 的 协作 依赖 程度 ， 以 及 确定 任务 分 
配 的 时 间 范 围 。Gerkey 和 Mataric^ 5 定义 了 一 套 任 
务 分 配 的 分 类 系统 ， 提 供 在 上 述 诸多 方面 区 分 任务 分 
配 问题 的 一 个 途径 ， 称 为 多 机 器 人 任务 分 配 (MR- 
TA) 分 类 系统 。 


40.6.1 任务 分 配 的 分 类 系统 


一 般 地 ， 任 务 分 为 两 种 主要 类 别 : 单机 器 人 任务 
(SR， 根 据 MRTA 分 类 系统 ) 指 一 次 只 需要 一 个 机 器 
人 的 任务 ， 而 多 机 器 人 任务 (MR) 则 同时 需要 超过 
一 个 机 器 人 执行 同一 任务 。 通 常 ， 具 有 最 小 任务 依赖 
程度 的 单机 器 人 任务 称 为 松散 耦合 任务 ， 代 表 一 个 弱 
协同 解 。 另 一 方面 ， 多 机 器 人 任务 通常 被 认为 是 一 系 
列 具 有 强烈 相互 依赖 关系 的 子 任务 。 这 些 任 务 因 此 常 
被 称 为 紧密 耦合 任务 ， 它 们 需要 一 个 紧密 协同 的 解 。 
松散 耦合 多 机 器 人 任务 的 子 任务 需要 子 任 务 之 间 有 高 
层次 的 同步 或 者 协同 ， 意 味 着 每 一 项 任务 必须 以 很 小 
的 时 间 延 迟 留 意 其 他 协同 子 任务 的 当前 状态 。 当 时 间 
延迟 逐渐 变 大 ， 协 同 的 子 任务 之 间 的 耦合 会 变 得 更 加 
松散 ， 即 代表 松散 协同 解 。 

机 器 人 也 可 以 分 为 单 任 务 机 器 人 (ST)， 即 一 次 
只 能 执行 一 项 任务 ， 或 者 多 任务 机 器 人 (MT) ， 一 次 
能 够 执行 超过 一 项 任务 。 大 多 数 时 候 ， 任 务 分 配 问 题 
假设 机 器 人 是 单 任 务 机 器 人 ， 因 为 功能 更 加 强大 ， 能 
够 并 行 执行 多 项 任务 的 机 器 人 仍然 超出 当前 的 技术 发 
展 水 平 。 

任务 分 配 或 以 优化 瞬时 任务 分 配 (IA) 为 目标 ， 
或 者 为 将 来 时 刻 优化 分 配 (TA， 时 间 扩 展 分 配 )。 在 


瞬时 分 配 的 情况 下 ， 不 考虑 当前 分 配对 将 来 分 配 的 影 
响 。 时 间 扩 展 分 配 尝试 分 配 任务 使 得 队伍 的 性 能 不 仅 
为 当前 时 间 步 又 需要 完成 的 任务 集合 ， 也 为 可 能 需 
的 整个 任务 集合 做 优化 。 

利用 MTRA 分 类 系统 ， 用 上 述 这 些 缩写 的 三 元 
组 来 对 不 同 的 任务 分 配方 法 进行 归 类 ， 例 如 SR-ST- 
IA， 即 单机 器 人 任务 一 次 性 分 配给 单 任 务 机 器 人 的 
分 配 问 题 。 任 务 分 配 问题 的 不 同 变种 具有 不 同 的 计 
算 复 杂 度 。 最 容易 的 变种 是 ST- SR-IA 问题 ， 因 为 
它 是 优化 分 配 问题 的 一 个 例子 ， 故 可 在 多 项 式 时 间 
内 求解 下 外。 其 他 的 变种 要 难得 多 ， 也 没有 已 知 的 
多 项 式 时 间 解 。 例 如 ， 能 够 证 明 ST-SR-IA 变种 是 
集合 划分 问题 中 的 一 个 例子 ， 这 是 一 个 强 NP XE 
度 问 题 。ST- MR-IA，ST-SR-IA 和 ST-SR- TA 变种 
也 都 被 证 明 是 NP 难度 问题 。 因 为 这 些 问 题 计算 复 
杂 ， 大 多 数 多 机 器 人 队伍 任务 分 配方 法 生成 的 是 近 
似 解 。 


40.6.2 ”代表 性 方法 


多 机 器 人 队伍 的 任务 分 配方 法 能 大 略 地 分 为 基于 
行为 的 方法 和 基于 市 场 《有 时 也 称 为 谈判 型 或 者 基 
于 拍卖 ) 的 方法 。 本 节 接 下 来 的 部 分 描述 这 些 通用 
方法 的 一 些 代表 性 的 架构 。 有 关 以 上 部 分 方法 在 计 
算 、 通 信 要 求 以 及 求解 质量 方面 的 比较 性 分 析 ， 请 见 
参考 文献 [40.63]. 

1. 基于 行为 的 任务 分 配 

基于 行为 的 方法 通常 能 使 机 器 人 在 没有 明确 
讨论 单个 任务 的 情况 下 确定 任务 分 配 。 在 这 些 方 
法 中 ， 机 器 人 利用 对 机 器 人 队伍 的 使 命 、 机 器 人 
队伍 成 员 的 功能 和 机 器 人 行动 的 当前 状态 的 了 
解 ， 以 分 布 方式 决定 哪 一 个 机 器 人 应 该 执行 哪 项 
任务 。 

基于 行为 的 ALLIANCE 架构 °°) AAAY L- AL- 
LIANCE 架构 “中 是 最 早 的 多 机 器 人 任务 分 配 体 系 
架构 之 一 ， 并 在 物理 机 器 人 上 证 明 过 。ALLIANCE 针 
对 任务 分 配 问 题 的 ST-SR-IA 和 ST-SR- TA 变种 ， 在 
机 器 人 之 间 没 有 直接 的 通信 。 如 第 40.2.2 节 所 述 ， 
ALLIANCE 利用 动机 性 的 行为 ， 即 每 个 机 器 人 内 在 的 
焦躁 与 默许 的 级 别 ， 可 确定 自身 和 同伴 执行 特定 任务 
的 相对 适合 度 ， 从 而 取得 自 适 应 行动 选择 。 基 于 任务 
需求 、 同 伴 的 行动 和 功能 以 及 机 器 人 内 部 状态 来 计算 
这 些 动机 。 这 些 动机 有 效 地 计算 每 一 个 机 器 人 一 任务 
对 的 效用 尺度 。 

另外 一 种 基于 行为 的 多 机 器 人 任务 分 配方 法 是 
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本 地 适 任 度 广播 (BLE), eho A EE 
配 的 ST- SR-IA 变种 。BLE 利用 一 种 包容 型 行为 控 
制 体系 结构 ”1 ， 人 允许 持续 地 广播 本 地 计算 的 适 任 
度 并 只 选择 具有 最 高 适 任 度 的 机 器 人 来 执行 任务 ， 
使 得 机 器 人 可 以 有 效 地 执行 任务 。 在 这 种 情况 下 ， 
通过 行为 抑制 来 取得 任务 分 配 。BLE 使 用 一 种 与 
Botelho 和 Alami 的 M+ 体系 结构 类似 的 分 配 
算法 。 

2. 基于 市 场 的 任务 分 配 

基于 市 场 (或 基于 谈判 ) 的 方法 通常 包含 机 
器 人 之 间 关 于 所 需 任 务 的 显 式 通信 ， 且 机 器 人 基 
于 它们 的 功能 和 可 用 性 来 竞标 任务 。 谈 判 过 程 基 
于 市 场 理 论 ， 即 机 器 人 队伍 寻求 基于 单个 机 器 人 


1 


环境 中 产生 有 效 且 和 鲁 棒 的 多 机 器 人 协作 。 在 市 场 经 济 
中 ， 机 器 人 基于 自我 兴趣 行动 。 机 器 人 试图 完成 一 项 
任务 时 收 到 回报 并 承担 成 本 。 目 标 是 机 器 人 通过 拍 
卖 /谈判 来 进行 任务 交易 ， 使 得 队伍 的 利润 ( 回报 减 
去 成 本 ) 最 优 。 

Hoplites 方法 “下 集中 在 通过 将 联合 的 回报 与 
成 本 整合 到 投标 中 ， 选 出 合适 的 联合 计划 供 机 絮 人 
队伍 执行 。 这 种 方法 将 规划 与 被 动 和 主动 协同 战略 
连接 到 一 起 ， 令 机 器 人 可 以 根据 任务 变化 的 需要 改 
变 协同 战略 。 为 完成 选 定 的 计划 ， 预 先 定 义 好 了 机 
器 人 战略 。 

有 些 蔡 代 方 法 将 待 分 配 的 目标 表示 成 角色 ， 通 党 
把 机 器 人 扮演 特定 角色 时 应 该 执行 的 一 系列 任务 和 / 


执行 特定 任务 的 效用 来 优化 一 个 目标 函数 。 该 方 
法 通常 会 渴望 向 能 以 最 高 的 效用 执行 任务 的 机 器 
人 分 配子 任务 。 

Smith 提出 的 合同 网 协议 (CNP) 中 第 一 个 
针对 机 器 人 单元 如 何 能 通过 谈判 来 协作 解决 一 系 
列 任务 。Botelho FI Alami 的 M Jf A £t fy! 99 58 
一 个 将 基于 市 场 的 方法 用 于 多 机 器 人 任务 分 配 。 
在 M+ 方 法 中 ， 机 器 人 为 已 分 配 的 任务 规划 它们 
各 自 的 路 径 。 然 后 与 同伴 彼此 协商 ， 利 用 有 助 于 
合并 规划 的 社会 法 则 来 逐渐 调整 自己 的 行动 ， 使 
队伍 成 为 一 个 整体 。 

自从 这 些 早 期 的 发 展 之 后 ， 又 开发 了 许多 基于 市 
场 任务 分 配 的 替代 方法 。 参 考 文献 [40.70] 给 出 了 
详尽 的 关于 多 机 器 人 任务 分 配 最 新 技术 发 展 的 调查 ， 
并 在 解 的 质量 、 可 缩放 性 、 动 态 事件 与 环境 、 不 均匀 
性 等 方面 对 替代 方法 进行 了 比较 。 

当前 大 部 分 基于 市 场 的 任务 分 配方 法 针对 ST-SR 
问题 的 变种 ， 也 有 些 方法 (例如 参考 文献 【40. 11 ， 
71-73]) 针对 瞬时 分 配 (IA) ， 还 有 其 他 方法 〈 例 如 
参考 文献 [40.44, 74-76]) 处 理 的 是 时 间 扩 展 分 配 
(TA)。 最 近 的 方法 开始 处 理 多 机 器 人 任务 的 分 配 
( 即 MR-ST 问题 的 变种 )， 包括 参 考 文献 [40.59, 
77-81] ) 。 在 参考 文献 [40.82] 中 可 找到 MR-ST 问 
题 变 种 的 一 个 示例 方法 。 

代表 性 的 基于 市 场 的 方法 包括 MURDOCH 97", 
TradeBots 0:1] Hoplites 1*7, MURDOCH X 
法 忆 刀 采用 一 种 以 资源 为 中 心 的 发 布 一 订阅 通信 模 
型 来 进行 拍卖 ， 具 有 匿名 通信 的 好 处 。 在 这 种 方法 
中 ， 一 项 任务 由 所 需 的 资源 来 代表 ， 例 如 环境 传 感 
器 。 有 关 如 何 使 用 这 样 的 传感器 来 产生 满意 结果 的 方 
法 被 预先 编程 并 写 和 机器人。 

TraderBots 方法 由 9 利用 市 场 经 济 技术 在 动态 


或 行为 打包 。 然 后 按照 与 基于 拍卖 的 方法 (例如 ， 
参考 文献 [40. 11，61]) 类 似 的 方式 将 角色 动态 分 
配给 各 机 带 人 。 


40.7 学习 


多 机 器 人 学 习 问 题 是 学 习 新 的 协作 行为 ， 或 者 在 
其 他 机 器 人 在 场 的 情况 下 的 学 习 。 但是， 环境 中 的 其 
他 机 器 人 具有 它们 各 自 的 目标 ， 因 此 可 能 以 并 行 方式 
F M08) 。 挑 战 在 于 环境 中 存在 其 他 机 器 人 触犯 了 
马尔 可 夫 性 质 一 一 关于 单机 器 人 学 习 方 法 的 一 个 基本 
假设 中 。 多 机 器 人 学 习 问 题 特别 具有 挑战 ， 因 为 
它 综 合 了 单机 器 人 学 习 与 多 主体 学 习 的 难度 。 多 机 吕 
人 学 习 中 必须 考虑 的 特殊 困难 包括 连续 状态 与 活动 空 
间 、 指 数 状 态 空 间 、 分 布 式 信任 度 分 配 、 有 限 的 培训 
时 间 和 不 足 的 培训 数据 、 传 感 与 共享 信息 的 不 确定 
性 、 非 确定 性 行为 、 难 以 对 学 习 到 的 信息 定义 合适 的 
系统 抽象 、 难 以 合并 从 不 同 机 器 人 的 经 验 学 习 到 的 
信息 。 

已 经 研究 过 的 多 机 器 人 学 习 应 用 类 别 包括 多 
EAR 89) LEE Tx qu 705. Kp dS dS 
gu 4557,55). we4E-pUS I, gm eUo7. ， 和 多 机 器 
AGRERSEUS 997 。 多 机 器 人 学 习 特 别 具 有 挑战 的 领 
域 是 那些 具备 固有 协作 性 的 任务 。 固 有 协作 任务 不 能 
再 进一步 分 解 成 独立 的 可 由 单个 机 器 人 求解 的 子 任 
务 。 相 反 ， 一 个 机 器 人 的 行动 功效 取决 于 其 他 同伴 当 
前 的 行动 。 这 种 类 型 的 任务 在 多 机 器 人 学 习 中 特别 具 
有 挑战 性 ， 因 为 为 机 器 人 队伍 成 员 的 单独 行动 分 配 信 
用 很 困难 。 

信任 度 分 配 问题 特别 有 挑战 性 ， 因 为 一 个 机 器 人 
很 难 确 定 它 的 适合 度 (好 或 者 坏 ) 是 由 它 自己 的 行 
为 ， 或 另外 一 个 机 器 人 的 行为 造成 的 。 正 如 Pugh 和 
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移动 式 和 分 布 式 机 器 人 技术 


Martinoli 在 参考 文献 [40.91] 中 所 讨论 的 ， 在 机 器 
人 不 直接 共享 它们 的 意图 的 情况 下 ， 该 问题 变 得 特别 
困难 。 信 任 度 分 配 问题 的 两 种 不 同 变 体 在 多 机 器 人 学 
习 中 很 常见 。 第 一 种 是 机 器 人 学 习 单 独 的 行为 ， 但 是 
有 其 他 机 器 人 在 场 并 能 影响 其 性 能 。 第 二 种 是 机 器 人 
试图 在 一 个 共享 的 适应 函数 下 学 习 一 项 任务 。 确 定 如 
何 分 解 适应 函数 以 奖赏 或 者 处 罚单 个 机 器 人 的 贡献 是 
很 困难 的 事 。 

单机 器 人 系统 (例如 ,第 38 章 有 关 在 基于 行为 
的 系统 中 学 习 的 讨论 ， 第 39 章 关 于 基本 学 习 技巧 的 
讨论 ) 和 多 主体 系统 ”| 领域 的 学 习 已 经 有 广泛 包 
人 研究， 而 在 多 机 器 人 学 习 领 域内 的 研究 就 少 很 多 ， 虽 


域 ; 第 37 章 提 到 了 关于 多 机 天 人 系统 在 这 些 问题 
上 的 应 用 的 一 部 分 研究 。 本 手册 的 第 6 篇 列 出 了 
很 多 不 仅 与 单机 器 人 系统 ， 而 且 与 多 移动 机 器 人 
相关 的 应 用 领域 。 和 馆 今 为 止 ， 这 样 的 多 机 器 人 系 
统 的 实际 应 用 相对 较 少 ， 主 要 原因 是 多 机 器 人 系 
统 的 复杂 度 以 及 相对 较 新 的 支撑 技术 。 尽 管 如 此 ， 
还 是 有 许多 物理 多 机 器 人 系统 概念 的 原理 验证 ; 
人 们 期 望 随 着 技术 持续 成 熟 ， 这 些 系统 将 会 投入 
到 更 多 的 实际 应 用 中 去 。 

多 移动 机 器 人 系统 的 研究 经 常 在 常见 的 应 用 测试 
领域 背景 下 进行 。 虽 然 还 没有 上 升 到 基准 测试 任务 的 
层次 ， 但 这 些 常 见 领域 为 研究 者 提供 了 对 比 多 机 器 人 


然 该 主题 正 获 得 更 多 的 关注 。 迄 今 为 止 的 很 多 人 研究 集 
中 于 强化 型 学 习 方法 。 这 种 多 机 器 人 学 习 研 究 的 一 些 
例子 包括 Asada 等 人 的 研究 ”1 ， 他 提出 了 一 种 通过 
Q- 学 习 协 同 之 前 学 到 的 行为 ， 从 而 学 习 新 的 行为 的 
方法 ， 并 将 其 应 用 于 足球 赛 机 器 人 。 Mataric 9 9) 4-28 
了 一 种 利用 非 监督 式 强 化 学 习 、 非 均匀 奖励 函数 以 及 
过 程 估计 子 来 将 基本 行为 组 合成 高 阶 行为 的 方法 。 该 
机 制 应 用 在 机 器 人 队伍 上 学 习 执 行 砚 食 任 务 。Kubo 
和 Kakazu ^ ** 3 Hy T 53 Sb — Ph H IER (ORE f i EAE 
量 的 强化 学 习 机 制 ， 并 将 其 应 用 到 一 个 仿真 的 苋 争取 
lut EE E., Fernandez 4 A 79! 应 用 强化 学 习 算 
法 ， 基 于 状态 一 空间 离散 来 结合 监督 式 函数 近似 与 归 
纳 方法 ， 并 将 其 应 用 到 学 习 多 机 器 人 追踪 问题 的 机 器 


= 


控制 替代 策略 的 机 会 。 并 且 ， 虽 然 这 些 常 见 测试 领域 
通常 只 是 实验 室 阶段 的 测试 ， 但 它们 与 实际 应 用 相关 
联 。 本 节 列 举 了 这 些 常 见 的 应 用 领域 ; 有 关 这 些 领域 
的 讨论 和 相关 研究 更 详细 的 列举 ， 请 见 参考 文献 
[40.2] 和 参考 文献 [40.100], 


D. ei E. 


融 食 是 多 机 器 人 系统 的 一 项 流行 的 测试 应 用 ， 特 
别 是 对 于 处 理 群 体 机 器 人 和 包含 大 量 移动 机 器 人 的 那 
些 方法 。 在 砚 食 领域 ， 如 圆 盘 或 者 食物 弹丸 的 目标 分 
布 于 整个 平面 地 形 ， 机 器 人 的 任务 就 是 收集 这 些 目标 
并 将 他 们 送 到 一 个 或 者 多 个 收集 位 置 ， 例 如 基地 。 疯 
食 主要 用 于 研究 松散 协作 机 右 人 系统 ， 即 单个 机 絮 人 


40. 8.1 


A. Bowling 和 Veloso 9: 开发 了 一 种 通用 的 、 可 
缩放 的 学 习 算 法 ， 称 为 GraWoLF (基于 梯度 赢 取 或 
快速 学 习 ) ， 它 组 合 了 基于 梯度 的 策略 学 习 技 术 与 可 
变 学 习 速 率 ， 并 在 对 抗 性 的 多 机 吉 人 足球 应 用 中 证 明 
了 其 效果 。 

其 他 非 基于 强化 的 多 机 器 人 学 习 方 法 包括 Parker 
的 L-ALLIANCE 系统 结构 “ "1 ， 它 利用 参数 调整 ， 
基于 统计 经 验 数据 ， 在 执行 一 系列 任务 中 学 习 不 同 的 
非 均 匀 机 器 人 的 适应 度 。 针 对 学 习 避 障 的 任务 ， 
Pugh 和 Martinoli ® 2 将 粒子 群 优化 技术 应 用 到 分 布 
式 非 监督 型 机 器 人 的 分 组 学 习 。 


T 


40.8 应 用 


应 用 多 移动 机 器 人 系统 能 使 许多 实际 应 用 潜 
在 获 益 。 应 用 范例 包括 码头 容器 管理 ””” 、 行 星 
外 探测 中 、 搜 索 与 救援 沁 、 矿 物 开 采 、 交 


WW. TRS RAB, eA FE Be RED 
Wee 40-9] 、 dz fap [40.97.98] 、 4e My Fl Oe JE FE p tn 多 


机 器 人 系统 也 应 用 在 定位 、 地 图 绘制 和 探测 等 领 


的 行动 不 一 定 需要 彼此 紧密 同步 。 该 任务 传统 上 就 是 
多 机 器 人 系统 的 研究 对 象 ， 因 为 它 与 激励 了 群体 机 器 
人 研究 的 生物 系统 很 类 似 。 但 是 ， 它 也 与 数 个 实际 应 
用 相关 联 ， 例 如 有 毒 废物 清除 、 搜 索 与 救援 、 地 雷 移 
除 。 而 且 ， 为 了 发 现 目标 ， 驶 食 通 党 要 求 机 器 人 勘查 
整个 地 形 ， 因 此 在 覆盖 领域 存在 着 与 更 食 应 用 相似 的 
问题 。 在 覆盖 中 ， 机 器 人 被 要 求 遍 历 它们 所 处 环境 的 
所 有 区 域 ， 可 能 搜索 目标 (例如 地 雷 ) 或 者 在 环境 
的 所 有 部 分 执行 某 些 行动 (例如 地 面 清扫 )。 和 覆盖 应 
用 也 与 诸如 排 雷 、 草 坪 打 理 、 环 境 制 图 和 农业 等 任务 
有 实际 的 关联 。 

在 疯 食 与 覆盖 应 用 中 ， 一 个 基本 的 问题 是 如 何 令 
机 器 人 可 以 快速 地 勘查 环境 而 没有 重复 的 行动 或 者 披 
此 干扰 。 替 代 策 略 包 括 基本 的 间接 通信 T. BE 
JE 751 AA IELA 。 现 食 和 /或 覆盖 领 
域内 其 他 已 证 实 了 的 研究 包括 参考 文献 【40. 22 41, 
101-106]。 


40.8.2 群集 与 成 形 
自从 多 移动 机 器 人 系统 开创 以 来 ， 协 同 机 器 人 
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彼此 的 运动 就 一 直 是 该 领域 的 一 个 研究 课题 。 特 别 
是 群集 与 成 形 控制 问题 受到 了 很 多 的 关注 。 和 群集 问 
题 可 以 看 做 成 形 控 制 问题 的 一 个 子 类 ， 它 要 求 机 器 
人 在 集合 的 过 程 中 沿 着 某 些 路 径 一 起 移动 ， 但 是 对 
特定 机 器 人 所 走 的 路 径 只 有 最 低 限 度 的 要 求 。 成 形 
则 更 严格 ， 它 要 求 机 器 人 在 环境 中 移动 的 时 候 保持 
某 种 相对 位 置 。 在 这 些 问 题 中 ， 假 定 机 器 人 只 具备 
最 低 限 度 的 传 感 、 计 算 、 制 动 器 和 通信 功能 。 和 群集 
和 成 形 控 制 研 究 中 的 一 个 关键 问题 是 确定 每 个 机 器 
人 本 地 控制 法 则 的 设计 ， 以 产生 期 望 的 偶发 性 协同 
行为 。 其 他 问题 包括 如 何 合作 定位 自身 的 位 置 以 取 
得 成 形 控制 (例如 参考 文献 [40.42，107] ) ， 以 及 
为 固定 排列 多 机 器 人 队 形 规划 路 径 (例如 参考 文献 
[40. 108]) 。 

早期 成 形 问题 的 人 工 代 理解 决 方案 由 Reyno- 
Ids 529 利用 基于 规则 的 方法 生成 。 类 似 的 基于 行为 
或 规则 的 方法 已 被 用 于 物理 机 器 人 的 证 明和 研究 ， 例 
如 参考 文献 【40. 110]。 这 些 早期 的 解决 方案 是 基于 
人 工 产生 且 被 证 明 在 实际 中 可 行 的 本 地 控制 规则 。 更 
近期 的 研究 基于 控制 理论 原理 ， 集 中 在 证 明 多 机 器 人 
队伍 行为 中 的 稳定 性 和 收敛 性 。 这 种 研究 的 例子 包括 
参考 文献 [40.36, 111-119], 


40.8.3 ” 推 箱 子 与 机 器 人 协同 操纵 


推 箱子 与 机 器 人 协同 操纵 是 证 明 多 机 器 人 协作 
的 流行 领域 ， 因 为 它们 提供 了 一 个 需要 紧密 协同 和 
合作 的 领域 。 推 箱子 要 求 机 器 人 队伍 将 箱子 从 起 始 
位 置 移动 到 指定 的 目标 位 置 ， 有 时 需要 沿 着 规定 的 
路 径 。 典 型 情况 下 ， 推 箱子 在 一 个 平面 上 进行 ， 并 
假设 箱子 太 重 或 者 太 长 以 至 于 单个 机 器 人 不 能 推动 。 
有 时 有 好 几 个 箱子 需要 推动 ， 箱 子 间 的 优先 顺序 依 
赖 关 系 限 制 了 移动 的 次 序 。 机 器 人 协同 操纵 与 之 类 
似 ， 它 要 求 机 器 人 举 起 物体 并 运送 到 终点 。 因 为 机 
器 人 经 常 需要 对 其 行动 进行 同步 以 顺利 执行 任务 ， 
该 试验 平台 领域 用 于 强 协 作 多 机 器 人 策略 的 研究 。 
推 箱子 与 机 器 人 协同 操纵 领域 很 流行 ， 也 因为 它 与 
几 个 实际 应 用 相关 联 °°) ， 包 括 仓库 保管 、 卡 车 上 
货 与 卸货 、 在 工业 环境 中 输送 大 个 物体 以 及 装配 大 
规模 结构 。 

研究 者 通常 强调 他 们 的 机 器 人 合作 控制 方法 在 推 
箱子 与 机 器 人 协同 操纵 领域 内 的 不 同方 面 。 例 如 ， 
Kube 和 Zhang 5 证 明了 蜂 群 型 协同 控制 技术 如 何 
能 实现 推 箱子 ， Parker 9.19.79! WB T H x& WY FES 4 
与 学 习 ，Donald EA”! 阐明 了 信息 不 变 和 传 感 、 


通信 以 及 控制 的 互 换 ，Simons 等 人 所 本 证 明了 利用 
协同 控制 建造 行星 栖息 地 的 可 行 性 。 该 领域 还 有 很 多 
另外 的 研究 ， 代 表 性 的 例子 包括 参考 文献 [40.3，6， 
31, 71, 96, 122-130], 


40.8.4 多 目标 观测 


多 目标 观测 领域 要 求 多 个 机 器 人 监测 和 /或 观察 
多 个 在 环境 中 移动 的 目标 。 目 的 是 在 任务 执行 过 程 中 
使 目标 保持 在 部 分 机 器 人 成 员 视 野 中 的 时 间或 者 可 能 
性 最 大 化 。 如 果 目 标 比 机 器 人 更 多 ， 任 务 可 能 特别 有 
挑战 性 。 该 应 用 领域 有 助 于 强 协作 任务 的 解决 方案 ， 
因为 机 器 人 需要 协同 运动 或 者 切换 跟踪 目标 以 使 目的 
最 大 化 。 在 多 移动 机 器 人 应 用 的 背景 下 ， 该 测试 平台 
的 平面 版 本 在 参考 文献 [40.131] 中 被 首先 引入 用 
于 多 机 器 人 协作 观测 多 个 移动 目标 (CMOMMT) 。 有 
数 名 研究 者 已 经 研究 了 类 似 的 问题 ， 并 将 其 扩展 到 更 
复杂 的 问题 ， 例 如 环境 具有 复杂 的 地 形 或 者 三 维 情况 
下 多 个 飞行 机 器 人 的 应 用 。 该 领域 也 与 其 他 领域 的 问 
题 相 关联 ， 例 如 艺术 馆 走廊 监控 算法 、 追 逐 与 躲避 以 
及 传感器 覆盖 。 该 领域 在 安保 、 监 控 和 侦察 问题 方面 
有 许多 实际 的 应 用 。 属 于 多 机 器 人 系统 在 多 目标 观测 
问题 中 的 研究 还 包括 参考 文献 [40.47，66，132- 
136] 。 


40.8.5 ”交通 控制 和 多 机 器 人 路 径 规划 


当 多 个 机 器 人 在 一 个 共享 环境 中 运行 时 ， 必 
须 协同 其 行动 以 防止 干扰 。 当 机 器 人 运行 的 空间 
含有 瓶颈 区 域 , 例如 道路 网 络 或 者 机 器 人 占据 了 
可 航行 空间 相对 大 的 部 分 ， 这 些 问 题 通 常会 出 现 。 
在 这 些 问题 中 ， 空 旷 地 域 可 被 看 做 机 器 人 必须 尽 
可 能 共享 的 资源 以 避免 障碍 和 死 锁 。 在 该 领域 中 ， 
机 器 人 通常 具有 各 自 的 目标 ， 必 须 与 其 他 机 器 人 
协作 以 确保 享有 的 共享 空间 足够 完成 它们 的 目标 。 
在 有 些 变 体 情况 下 ， 多 个 机 器 人 的 所 有 路 径 需 要 
彼此 协同 ; 在 其 他 变 体 情 况 下 ， 机 器 人 必须 简单 
地 避免 彼此 干扰 。 

很 多 不 同 的 方法 被 引入 来 处 理 这 个 问题 ， 包 括 交 
通 法 规 、 将 环境 分 成 单一 主权 单元 、 几 何 路 径 规划 。 
针对 这 个 问题 的 许多 早期 研究 基于 启发 式 方法 ， 例 如 
预先 定义 能 防止 死 锁 的 运动 控制 (或 交通 ) 法 
Jio ， 或 者 利用 与 分 布 式 计 算 中 的 互 斥 类 似 的 
途径 四 91。 这 些 方法 的 好 处 是 可 以 最 小 化 获得 解 
所 需 的 规划 成 本 。 其 他 更 正规 的 技术 将 该 应 用 视 为 几 
何 多 机 器 人 路 径 规划 问题 ， 可 以 在 位 姿 空间 一 时 间 域 
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内 精确 求解 。 第 5 章 包 含 了 与 该 领域 相关 的 多 机 器 人 
运动 规划 讨论 。 尽 管 几何 运动 规划 方法 提供 了 最 通用 
的 解 ， 它 们 的 计算 量 在 实际 应 用 中 通常 太 大 以 至 于 不 


此 检查 了 系统 结构 、 通 信 问 题 、 群 体 机 器 人 系统 、 非 
均匀 队伍 、 任 务 分 配 、 学 习 和 应 用 。 很 清楚 的 是 ， 在 
最 近 10 年 中 这 一 领域 取得 了 重大 的 进展 。 但 是 它 仍 


切实 际 ， 原 因 是 环境 具有 动态 本 质 ， 或 者 该 方法 对 于 
当前 问题 而 言 根 本 不 需要 。 在 这 些 情况 下 ， 启 发 式 方 
法 可 能 已 经 足够 。 


40.8.6 ”机 器 人 足球 赛 


自从 机 器 人 足球 世界 杯 举 办 以 来 ， 多 机 器 人 足球 
领域 所 S 作 为 研究 多 机 器 人 系统 协同 和 控制 的 一 个 
挑战 性 问题 诞生 后 ， 该 领域 的 研究 有 了 极 大 的 增长 。 
该 领域 整合 了 多 机 器 人 控制 的 许多 挑战 性 因素 ， 包 括 
合作 、 机 器 人 控制 系统 结构 、 策 略 获取 、 实 时 推理 和 
行动 、 传 感 器 融合 、 处 理 对 抗 性 环境 、 认 知 模拟 和 学 
习 。 一 年 一 度 的 竞赛 展示 了 机 器 人 队伍 在 多 种 设置 中 
的 功能 一 直 在 提高 ， 如 图 40.8 所 示 。 该 领域 具有 一 
个 其 他 多 机 器 人 测试 领域 所 不 具备 的 关键 因素 ， 即 机 
器 人 必须 在 对 抗 性 的 环境 中 运作 。 因 为 其 在 教育 领域 
的 作用 ， 该 领域 也 很 普及 ， 它 将 全 世界 的 学 生 与 研究 
者 汇集 到 这 项 竞赛 中 以 赢 取 机 器 人 足球 世界 杯 的 挑 
战 。 机 器 人 足球 世界 杯 的 竞赛 已 经 增加 了 额外 的 搜索 
RGA HO) ， 该 项 目 也 已 变 成 了 重要 的 研究 领 
域 (该 领域 更 多 的 细节 请 参见 第 50 E), HLA E 
球 世 界 杯 的 年 度 会 议 记 录 记 载 了 很 多 已 经 整合 进 多 机 
器 人 足球 队伍 的 研究 成 果 。 部 分 代表 性 的 研究 成 果 包 
括 参 考 文 献 【40. 145-149] 。 


图 40.8 足 式 机 器 人 队伍 参加 机 器 人 足球 赛 


40.9 结论 与 扩展 阅读 


本 音调 查 了 多 机 器 人 系统 当前 的 研究 状况 ， 并 以 


然 是 一 个 活跃 的 研究 领域 , 还 有 很 多 研究 课题 待 解 
决 。 关 键 性 的 待 解决 问题 仍 存在 于 很 宽广 的 领域 ， 如 
系统 集成 、 鲁 棱 性 、 学 习 、 可 缩放 性 、 通 用 化 以 及 处 
理 非 均 匀 性 。 

例如 ， 在 系统 集成 领域 有 一 个 待 解 决 的 问题 是 如 
何 有 效 地 令 机 器 人 队伍 组 合 一 系列 方法 以 获得 能 够 执 
行 超 过 有 限 任务 集 的 完整 机 器 人 。 在 鲁 棒 性 领域 ， 多 
机 器 人 队伍 仍然 需要 提高 (故障 时 ) 适当 地 降低 性 
能 的 能 力 、 推 理 容错 性 和 在 不 放大 故障 率 情 况 下 提高 
复杂 度 。 多 机 器 人 队伍 学 习 领 域 仍然 处 在 初级 阶段 ， 
待 解决 问题 包括 如 何在 多 机 器 人 队伍 中 取得 连续 学 
习 ， 如 何 有 助 于 复杂 表达 的 应 用 ， 以 及 如 何 让 人 能 影 
响 和 /或 理解 机 器 人 队伍 学 习 的 结果 。 在 更 复杂 的 环 
境 以 及 越 来 越 多 的 机 器 人 方面 ， 可 扩展 性 仍然 是 一 个 
有 挑战 的 问题 。 通 用 化 中 待 解决 的 问题 包括 使 机 器 人 
队伍 能 够 对 背景 进行 推理 ， 增 加 系统 的 多 样 性 从 而 可 
以 在 多 种 不 同 的 应 用 中 运作 。 在 非 均匀 性 的 处 理 中 ， 
待 解决 问题 包括 当 所 有 的 机 器 人 为 非 均匀 时 ， 确 定理 
论 方法 来 预测 系统 性 能 ， 以 及 决定 如 何 设 计 一 个 针对 
特定 应 用 最 优化 的 机 器 人 队伍 。 这 些 问题 以 及 其 他 问 
题 ， 预 示 着 多 移动 机 器 人 系统 领域 在 将 来 的 多 年 内 将 
持续 保持 活跃 。 

有 关 多 移动 机 器 人 系统 主题 的 更 多 阅读 ， 请 读者 
参考 该 领域 的 调查 文章 ,包括 参 考 文献 【40. 100, 
150，151]。 还 出 现 了 数 期 特别 针对 本 主题 的 期 刊 ， 
包括 参考 文献 [40. 1，152- 154 ] 。 人 参考 文献 [40.25, 
100, 155] 中 给 出 了 部 分 多 机 器 人 系统 的 分 类 体系 。 
多 种 关于 多 机 器 人 系统 主题 的 专题 讨论 会 与 讲习 班 定 
期 举行 ， 这 些 讲习 班 与 讨论 会 近期 的 会 议 录 包括 参考 
文献 [40. 156-163]。 参 考 文献 [40.164] 包含 有 关 
这 个 主题 的 附加 编辑 材料 。 


参考 文献 


40.1 T. Arai, E. Pagello, L.E. Parker: Editorial: Advances 
in multi-robot systems, IEEE Trans. Robot. Autom. 
18(5), 655-661 (2002) 

40.2 Y. Cao, A. Fukunaga, A. Kahng: Cooperative mo- 
bile robotics: Antecedents and directions, Auton. 
Robot. 4, 1—23 (1997) 

40.3 R.G. Brown, J.S. Jennings: A pusher/steerer model 
for strongly cooperative mobile robot manipula- 
tion, Proc. IEEE Int. Conf. Intell. Robot. Syst. (IROS 


第 40 章 多 机 器 人 系统 


393 


40.4 


40.5 


40.6 


40.7 


40.8 


40.9 


40.10 


40.11 


40.12 


40.13 


40.14 


40.15 


40.16 


40.17 


40.18 


40.19 


40.20 


40.21 


40.22 


'95) (IEEE, Pittsburgh 1995) pp. 562-568 

D. Milutinović, P. Lima: Modeling and optimal cen- 
tralized control of a large-size robotic population, 
IEEE Trans. Robot. 22(6), 1280-1285 (2006) 

B. Khoshnevis, G.A. Bekey: Centralized sensing and 
control of multiple mobile robots, Comput. Ind. 
Eng. 35(3-4), 503-506 (1998) 

M.J. Mataric: Issues and approaches in the design 
of collective autonomous agents, Robot. Auton. 
Syst. 16, 321-331 (1995) 

E. Ostergaard, G.S. Sukhatme, M.J. Mataric: Emer- 
gent bucket brigading, Fifth International Confer- 
ence on Autonomous Agents (Montreal 2001) 

M. Mataric: Reinforcement learning in the multi- 
robot domain, Auton. Robot. &, 73-83 (1997) 

L.E. Parker: ALLIANCE: An Architecture for Fault- 
Tolerant Multi-Robot Cooperation, IEEE Trans. 
Robot. Autom. 14(2) 220-240 (1998) 

L.E. Parker: Lifelong adaptation in heterogeneous 
teams: Response to continual variation in individ- 
ual robot performance, Auton. Robot. 8(3), 239-267 
(2000) 

R. Simmons, S. Singh, D. Hershberger, J. Ramos, 
T. Smith: First results in the coordination of heter- 
ogeneous robots for large-scale assembly, Proc. 
ISER 7th Int. Symp. Exp. Robot. (Springer, New York 
2000) 

J. Deneubourg, S. Goss, G. Sandini, F. Ferrari, P. 
Dario: Self-organizing collection and transport of 
objects in unpredictable environments. (Kyoto) pp. 
1093-1098 

C.R. Kube, H. Zhang: Collective robotics: From social 
insects to robots, Adapt. Behav. 2(2), 189—219 (1993) 
R. Beckers, 0. Holland, J. Deneubourg: From local 
actions to global tasks: Stigmergy and collective 
robotics, Proc. 14th Int. Workshop Synth. Simul. 
Living Syst., ed. by R. Brooks, P. Maes (MIT Press, 
Cambridge 1994) pp. 181-189 

S. Onn, M. Tennenholtz: Determination of social 
laws for multi-agent mobilization, Artif. Intell. 95, 
155-167 (1997) 

B.B. Werger: Cooperation without deliberation: 
A minimal behavior-based approach to multi- 
robot teams, Artif. Intell. 110(2) 293-320 (1999) 
M.J. Huber, E. Durfee: Deciding when to commit 
to action during observation-based coordination, 
Proc. 1st Int. Conf. Multi-Agent Syst. (1995) pp.163- 
170 

H. Asama, K. Ozaki, A. Matsumoto, Y. Ishida, 
|. Endo: Development of task assignment system 
using communication for multiple autonomous 
robots, J. Robot. Mechatron. &(2), 122-127 (1992) 

N. Jennings: Controlling cooperative problem solv- 
ing in industrial multi-agent systems using joint 
intentions, Artif. Intell. 75(2), 195-240 (1995) 

M. Tambe: Towards flexible teamwork, J. Artif. In- 
tell. Res. 7, 83-124 (1997) 

L.E. Parker: The Effect of action recognition and 
robot awareness in cooperative robotic teams, 
Proc. IEEE/RSJ Int. Conf. Intell. Robot. Syst. (IEEE, 
Pittsburgh 1995) pp. 212-219 

M. Mataric Behavior-based control: Examples 
from navigation, learning, and group behavior, 
J. Exp. Theor. Artif. Intell. 19(2-3), 323-336 (1997) 


40.23 


40.24 


40.25 


40.26 


40.27 


40.28 


40.29 


40.30 


40.31 


40.32 


40.33 


40.34 


40.35 


40.36 


40.37 


40.38 


40.39 


40.40 


B. MacLennan, G.M. Burghardt: Synthetic ethology 
and the evolution of cooperative communication, 
Adapt. Behav. 2, 161-188 (1993) 

T. Balch, R.C. Arkin: Communiation in reactive mul- 
tiagent robotic systems, Auton. Robot. 1(1), 27-52 
(1995) 

G. Dudek, M. Jenkin, E. Milios, D. Wilkes: A tax- 
onomy for multi-agent robotics, Auton. Robot. 3, 
375-397 (1996) 

G. Theraulaz, S. Goss, J. Gervet, J.-L. Deneubourg: 
Task differentiation in Polistes wasp colonies: 
A model for self-organizing groups of robots, Proc. 
1st Int. Conf. Simul. Adaptive Behavior (Paris 1990) 
pp. 346-355 

L. Steels: Cooperation Between Distributed Agents 
Through Self-Organization, ed. by Y. Demazeau, 
J.-P. Muller (Elsevier Science, Amsterdam 1990) 

A. Drogoul, J. Ferber: From tom thumb to the dock- 
ers: Some experiments with foraging robots, Proc. 
2nd Int. Conf. Simul. Adaptive Behavior (Honolulu 
1992) pp. 451-459 

M.J. Mataric: Designing emergent behaviors: From 
local interactions to collective intelligence, Proc. 
2nd Int. Conf. Simul. Adaptive Behavior, ed. by 
J. Meyer, H. Roitblat, S. Wilson (MIT Press, Cam- 
bridge 1992) pp. 432-441 

G. Beni, J. Wang: Swarm intelligence in cellular 
robotics systems, Proc. NATO Adv. Workshop Robot. 
Biol. Syst. (1989) 

D. Stilwell, J. Bay: Toward the development of 
a material transport system using swarms of ant- 
like robots, Proc. IEEE Int. Conf. Robot. Autom. 
(Atlanta 1993) pp. 766-771 

T. Fukuda, S. Nakagawa, Y. Kawauchi, M. Buss: Self 
organizing robots based on cell structures — CEBOT, 
Proc IEEE Int. Workshop Intell. Robot. Syst. (IEEE, 
1988) pp. 155-150 

J.H. Reif, H.Y. Wang: Social Potential fields: A dis- 
tributed behavior control for autonomous robots, 
Robot. Auton. Syst. 27(3), 171-194 (1999) 

L.E. Parker: Designing control laws for cooperative 
agent teams, Proc. IEEE Robot. Autom. Conf. (IEEE, 
Atlanta 1993) pp. 582-587 

K. Sugihara, |. Suzuki: Distributed algorithms for 
formation of goemetric patterns with many mobile 
robots, J. Robot. Syst. 13(3), 127-139 (1996) 

V. Gazi: Swarm aggregations using artificial poten- 
tials and sliding- mode control, IEEE Trans. Robot. 
21(6), 1208-1214 (2005) 

J. McLurkin, J. Smith: Distributed algorithms for 
dispersion in indoor environments using a swarm 
of autonomous mobile robots, Symp. Distrib. Au- 
ton. Robot. Syst. (Springer, 2004) 

D. Gage: Randomized search strategies with im- 
perfect sensors, Proc. SPIE Mobile Robots VIII (SPIE, 
Boston 1993) pp. 270-279 

T. Balch: The impact of diversity on performance in 
robot foraging, Proc. 3rd Ann. Conf. Auton. Agents 
(ACM Press, Seattle 1999) pp. 92-99 

A. Howard, M.J. Matarié, G.S. Sukhatme: An in- 
cremental self-deployment algorithm for mobile 
sensor networks, Auton. Robot. 13(2), 113-126 
(2002), Special Issue on Intelligent Embedded Sys- 
tems 


394 


第 5 篇 


移动 式 和 分 布 式 机 器 人 技术 


40.41 


40.42 


40.43 


40.44 


40.45 


40.46 


40.47 


40.48 


40.49 


40.50 


40.51 


40.52 


40.53 


40.54 


40.55 


40.56 


40.57 


40.58 


Z.J. Butler, A.A. Rizzi, R.L. Hollis: Cooperative 
coverage of rectilinear environments, Proc. IEEE 
Int. Conf. Robot. Autom. (IEEE, San Francisco 
2000) 

A.l. Mourikis, S.I. Roumeliotis: Performance anal- 
ysis of multirobot cooperative localization, IEEE 
Trans. Robot. 22(4), 666-681 (2006) 

R. Grabowski, L.E. Navarro-Serment, C.J. Pare- 
dis, P.K. Khosla: Heterogeneous teams of modular 
robots for mapping and exploration, Auton. Robot. 
8(3), 271-298 (2000) 

M. Berhault, H. Huang, P. Keskinocak, S. Koenig, 
W. Elmaghraby, P. Griffin, A. Kleywegt: Robot 
exploration with combinatorial auctions, Proc. 
IEEE/RSJ Int. Conf. Intell. Robot. Syst. (IEEE, 2003) 
pp.1957-1962 

J. Kim, J.M. Esposito, V. Kumar: An RRT-based 
algorithm for testing and validating mulit-robot 
controllers, Proc. Robot.: Sci. Syst. | (2005) 

Z. Cao, M. Tin, L. Li, N. Gu, S. Wang: Cooperative 
hunting by distributed mobile robots based on lo- 
cal interaction, IEEE Trans. Robot. 22(2), 403-407 
(2006) 

R.W. Beard, T.W. McLain, M. Goodrich: Coordinated 
target assignment and intercept for unmanned air 
vehicles, Proc. IEEE Int. Conf. Robot. Autom. (IEEE, 
Washington 2002) 

J. Clark, R. Fierro: Cooperative hybrid control of 
robotic sensors for perimeter detection and track- 
ing. (IEEE) pp. 3500-3505 

P. Stone, M. Veloso: A layered approach to learning 
client behaviors in the RoboCup soccer server, Appl. 
Artif. Intell. 12, 165-188 (1998) 

J. McLurkin: Stupid Robot Tricks: Behavior-Based 
Distributed Algorithm Library for Programming 
Swarms of Robots. M.S. Thesis (Massachusetts In- 
stitute of Technology, Cambridge 2004) 

L.E. Parker: The Effect of Heterogeneity in Teams 
of 100+ Mobile Robots. In: Multi-Robot Systems 
Volume II: From Swarms to Intelligent Automata, 
ed. by A. Schultz, L.E. Parker, F. Schneider (Kluwer, 
Dordrecht 2003) 

T. Balch: Hierarchic social entropy: An information 
theoretic measure of robot team diversity, Auton. 
Robot. 8(3), 209-238 (2000) 

D. Jung, A. Zelinsky: Grounded symbolic communi- 
cation between heterogeneous cooperating robots, 
Auton. Robot. 8(3), 269-292 (2000) 

R.R. Murphy: Marsupial robots for urban search and 
rescue, IEEE Intell. Syst. 15(2), 14-19 (2000) 

G. Sukhatme, J. F. Montgomery, R. T. Vaughan: Ex- 
periments with Cooperative Aerial-Ground Robots, 
Robot Teams: From Diversity to Polymorphism, ed. 
by T. Balch, L. E. Parker (A K Peters, Natick 2002) 
pp. 345-368 

L.E. Parker, B. Kannan, F. Tang, M. Bailey: Tightly- 
coupled navigation assistance in heterogeneous 
multi-robot teams, Proc. IEEE Int. Conf. Intell. 
Robot. Syst. (IEEE, 2004) 

A. Howard, L.E. Parker, G.S. Sukhatme: Experi- 
ments with a large heterogeneous mobile robot 
team: Exploration, mapping, deployment, and de- 
tection, Int. J. Robot. Res. 25, 431-447 (2006) 

L. Chaimowicz, B. Grocholsky, J.F. Keller, V. Kumar, 


40.59 


40.60 


40.61 


40.62 


40.63 


40.64 


40.65 


40.66 


40.67 


40.68 


40.69 


40.70 


40.71 


40.72 


40.73 


40.74 


C.J. Taylor: Experiments in multirobot air-ground 
coordination, Proc. IEEE Int. Conf. Robot. Autom. 
(IEEE, New Orleans 2004) 

L.E. Parker, F. Tang: Building multi-robot coalitions 
through automated task solution synthesis, Proc. 
IEEE 94(7), 1289-1305 (2006), special issue on Multi- 
Robot Systems 

R. Zlot, A. Stentz: Market-based multirobot coor- 
dination for complex tasks, Int. J. Robot. Res. 25(1), 
73-101 (2006) 

J. Jennings, C. Kirkwood-Watts: Distributed mobile 
robotics by the method of dynamic teams, Proc. 
4th Int. Symp. Distrib. Auton. Robot. Syst. Karlsruhe 
1998, ed. by T. Leuth, R. Dillman, P. Dario, H. Worn 
(Springer, Tokyo 1998) 

E. Pagello, A. D'Angelo, E. Menegatti: Coopera- 
tion issues and distributed sensing for multirobot 
systems, Proc. IEEE 94, 1370-1383 (2006) 

B. Gerkey, M.J. Mataric: A formal analysis and tax- 
onomy of task allocation in multi-robot systems, 
Int. J. Robot. Res. 23(9), 939-954 (2004) 

D. Gale: The Theory of Linear Economic Models 
(McGraw-Hill, New York 1960) 

E. Balas, M.W. Padberg: On the set-covering prob- 
lem, Oper. Res. 20(6), 1152-1161 (1972) 

B.B. Werger, M.J. Mataric: Broadcast of local eligi- 
bility for multi-target observation. In: Distributed 
Autonomous Robotic Systems 4, ed. by L.E. Parker, 
G. Bekey, J. Barhen (Springer, Tokyo 2000) pp. 347- 
356 

R.A. Brooks: A robust layered control system for 
a mobile robot, IEEE J. Robot. Autom. RA-2(1), 14-23 
(1986) 

S. Botelho, R. Alami: M+: A scheme for multi-robot 
cooperation through negotiated task allocation 
and achievement, Proc. IEEE Int. Conf. Robot. Au- 
tom. (IEEE, Detroit 1999) pp. 1234-1239 

R.G. Smith: The contract net protocol: High-level 
communication and control in a distributed prob- 
lem solver, IEEE Trans. Comput. C-29(12), 1104-1113 
(1980) 

B. Dias, R. Zlot, N. Kalra, A. Stentz: Market-based 
multirobot coordination: A survey and analysis, 
Proc. IEEE 94(7), 1257-1270 (2006) 

B.P. Gerkey, M.J. Mataric: Sold! Auction methods 
for multi-robot coordination, IEEE Trans. Robot. 
Autom. 18(5), 758-768 (2002) 

H. Kose, U. Tatlidede, C. Mericli, K. Kaplan, 
H. L.Akin: Q-learning based market-driven multi- 
agent collaboration in robot soccer, Proc. Turkish 
Symp. Artif. Intell. Neural Networks (Izmir 2004) 
pp. 219-228 

D. Vail, M. Veloso: Multi-robot dynamic role 
assignment and coordination through shared po- 
tential fields, multi- robot systems: From swarms to 
intelligent automata, Proc. Int. Workshop Multi- 
Robot Syst., Washington, D.C., ed. by A. Schultz, 
L.E. Parker, F. Schneider (Springer, Dordrecht 2003) 
pp.87-98 

M.Lagoudakis, E. Markakis, D. Kempe, P. KeshinocaK, 
A. Kleywegt, S. Koenig, C. Tovey, A. Meyer- 
son, S. Jain: Auction-based multi-robot routing, 
Robotics: Science and Systems | (MIT Press, Cam- 
bridge 2005) 


第 40 章 多 机 器 人 系统 


395 


40.75 


40.76 


40.77 


40.78 


40.79 


40.80 


40.81 


40.82 


40.83 


40.84 


40.85 


40.86 


40.87 


40.88 


40.89 


40.90 


40.91 


40.92 


G. Rabideau, T. Estlin, 9. Schien, A. Barrett: A com- 
parison of coordinated planning methods for 
cooperating rovers, Proc. AIAA Space Technol. Conf. 
(1999) 

R. Zlot, A. Stentz, M.B. Dias, S. Thayer: Multi-robot 
exploration controlled by a market economy, Proc. 
IEEE Int. Conf. Robot. Autom. (IEEE, Washington 
2002) pp. 3016-3023 

J. Guerrero, G. Oliver: Multi-robot task alloca- 
tion strategies using auction-like mechanisms, 
Proc. 6th Congr. Catalan Assoc. Artif. Intell. (2003) 
pp. 111-122 

N. Kalra, D. Ferguson, A. Stentz: Hoplites: A market- 
based framework for planned tight coordination 
in multirobot teams, Proc. IEEE Int. Conf. Robot. 
Autom. (IEEE, Barcelona 2005) 

L. Lin, Z. Zheng: Combinatorial bids based multi- 
robot task allocation method, Proc. IEEE Int. Conf. 
Robot. Autom. (IEEE, Barcelona 2005) pp. 1145- 
1150 

C.-H. Fua, S.S. Ge: COBOS: Cooperative backoff 
adaptive scheme for multirobot task allocation, 
IEEE Trans. Robot. 21(6), 1168-1178 (2005) 

E.G. Jones, B. Browning, M.B. Dias, B. Argall, 
M. Veloso, A. Stentz: Dynamically formed hetero- 
geneous robot teams performing tightly-coupled 
tasks, Proc. IEEE Int. Conf. Robot. Autom. (IEEE, 
Orlando 2006) pp. 570—575 

L. Vig, J.A. Adams: Multi-robot coalition formation, 
IEEE Trans. Robot. 22(4), 637-649 (2006) 

M. Bowling, M. Veloso: Simultaneous adversarial 
multi-robot learning, Proc. Int. Joint Conf. Artif. 
Intell. (2003) 

F. Fernandez, L.E. Parker: A reinforcement learn- 
ing algorithm in cooperative multi-robot domains, 
J. Intell. Robot. Syst. 43, 161-174 (2005) 

C.F. Touzet: Robot awareness in cooperative mobile 
robot learning, Auton. Robot. 2, 1-13 (2000) 

R. Steeb, S. Cammarata, F. Hayes-Roth, P. Thorndyke, 
R. Wesson: Distributed Intelligence for Air Fleet 
Control, Rand Corp. Technical Report, Number R- 
2728-AFPA (1981) 

M. Benda, V. Jagannathan, R. Dodhiawalla: On op- 
timal cooperation of knowledge sources, Boeing AI 
Center Technical Report BCS-G2010-28 (1985) 

T. Haynes, S. Sen: Evolving Behavioral Strategies 
in Predators and Prey, Adaptation and Learning 
in Multi-Agent Systems, ed. by G. Weiss, S. Sen 
(Springer, Berlin, Heidelberg 1986) pp. 113-126 

S. Mahadevan, J. Connell: Automatic programming 
of behavior-based robots using reinforcement 
learning, Proc. AAAI (1991) pp. 8-14 

S. Marsella, J. Adibi, Y. Al-Onaizan, G. Kaminka, 
I. Muslea, M. Tambe: On being a teammate: Expe- 
riences acquired in the design of RoboCup teams, 
Proc. 3rd Ann. Conf. Auton. Agents, ed. by O. Et- 
zioni, J. Muller, J. Bradshaw (1999) pp. 221-227 

J. Pugh, A. Martinoli: Multi-robot learning with 
particle swarm optimization, Proc. 5th Int. Joint 
Conf. Auton. Agents Multiagent Syst., Hakodate 
(ACM, New York 2006) pp. 441—448 

P. Stone, M. Veloso: Multiagent systems: A sur- 
vey from a machine learning perspective, Auton. 
Robot. 8(3), 345-383 (2000) 


40.93 


40.94 


40.95 


40.96 


40.97 


40.98 


40.99 


40.100 


40.101 


40.102 


40.103 


40.104 


40.105 


40.106 


40.107 


M. Asada, E. Uchibe, S. Noda, S. Tawaratsumida, 
K. Hosoda: Coordination of multiple behaviors ac- 
quired by a vision-based reinforcement learning, 
Proc. IEEE/RSJ/GI Int. Conf. Intell. Robot. Syst. (Mu- 
nich 1994) pp. 917-924 

M. Kubo, Y. Kakazu: Learning coordinated motions 
in a competition for food between ant colonies, 
Proc. 3rd Int. Conf. Simul. Adaptive Behavior, ed. 
by D. Cliff, P. Husbands, J.-A. Meyer, S. Wilson (MIT 
Press, Cambridge 1994) pp. 487—492 

R. Alami, S. Fleury, M. Herrb, F. Ingrand, F. Robert: 
Multi-robot cooperation in the MARTHA project, 
Robot. Autom. Mag. 5(1), 36-47 (1998) 

A. Stroupe, A. Okon, M. Robinson, T. Huntsberger, 
H. Aghazarian, E. Baumgartner: Sustainable coop- 
erative robotic technologies for human and robotic 
outpost infrastructure construction and mainte- 
nance, Auton. Robot. 20(2), 113-123 (2006) 

H.R. Everett, R.T. Laird, D.M. Carroll, G.A. Gilbreath, 
T.A. Heath-Pastore, R.S. Inderieden, T. Tran, K.J. 
Grant, D.M. Jaffee: Multiple Resource Host Archi- 
tecture (MRHA) for the Mobile Detection Assessment 
Response System (MDARS), SPAWAR Systems Techni- 
cal Documen 3026, Revision A (2000) 

Y. Guo, L.E. Parker, R. Madhavan: Towards 
collaborative robots for infrastructure security ap- 
plications, Proc. Int. Symp. Collab. Technol. Syst. 
(2004) pp. 235-240 

C. Hazard, P.R. Wurman, R. D'Andrea: Alphabet 
Soup: A testbed for studying resource allocation in 
multi-vehicle systems, Proc. AAAI Workshop Auc- 
tion Mechan. Robot Coord. (AAAI, Boston 2006) 
pp.23-30 

D. Nardi, A. Farinelli, L. locchi: Multirobot systems: 
A classification focused on coordination, IEEE Trans. 
Syst. Man Cybernet. Part B 34(5), 2015-2028 (2004) 
K. Passino: Biomimicry of bacterial foraging for dis- 
tributed optimization and control, IEEE Contr. Syst. 
Mag. 22(3), 52-67 (2002) 

M. Fontan, M. Mataric: Territorial multi-robot task 
division, IEEE Trans. Robot. Autom. 15(5), 815-822 
(1998) 

|. Wagner, M. Lindenbaum, A.M. Bruckstein: Mac 
vs. PC - Determinism and randomness as com- 
plementary approaches to robotic exploration of 
continuous unknown domains, Int. J. Robot. Res. 
19(1), 12-31 (2000) 

K. Sugawara, M. Sano: Cooperative behavior of in- 
teracting simple robots in a clockface arranged 
foraging field. In: Distributed Autonomous Robotic 
Systems, ed. by H. Asama, T. Arai, T. Fukuda, 
T. Hasegawa (Springer, Berlin, Heidelberg 2002) 
pp. 331-339 

P. Rybski, S. Stoeter, C. Wyman, M. Gini: A co- 
operative multi-robot approach to the mapping 
and exploration of Mars, Proc. AAAI/IAAI-97 (AAAI, 
Providence 1997) 

S. Sun, D. Lee, K. Sim: Artificial immune- 
based swarm behaviors of distributed autonomous 
robotic systems, Proc. IEEE Int. Conf. Robot. Autom. 
(IEEE, 2001) pp. 3993-3998 

A.l. Mourikis, S.l. Roumeliotis: Optimal sensor 
scheduling for resource-constrained localization of 
mobile robot formations, IEEE Trans. Robot. 22(5), 


396 


第 5 篇 


移动 式 和 分 布 式 机 器 人 技术 


40.108 


40.109 


40.110 


40.111 


40.112 


40.113 


40.114 


40.115 


40.116 


40.117 


40.118 


40.119 


40.120 


40.121 


40.122 


40.123 


40.124 


40.125 


40.126 


40.127 


917—931 (2006) 

S. Kloder, S. Hutchinson: Path planning for 
permutation-invariant multirobot formations, IEEE 
Trans. Robot. 22(4), 650-665 (2006) 

C.W. Reynolds: Flocks, herds and schools: A dis- 
tributed behavioral model, ACM SIGGRAPH Com- 
puter Graphics 21, 25-34 (1987) 

T. Balch, R. Arkin: Behavior-based Formation Con- 
trol for Multi-robot Teams, IEEE Trans. Robot. 
Autom. 14(6), 926-939 (1998) 

A. Jadbabaie, J. Lin, A.S. Morse: Coordination of 
groups of mobile autonomous agents using near- 
est neighbor rules, IEEE Trans. Autom. Contr. 48(6), 
988-1001 (2002) 

C. Belta, V. Kumar: Abstraction and control for 
groups of robots, IEEE Trans. Robot. 20(5), 865-875 
(2004) 

C.M. Topaz, A.L. Bertozzi: Swarming patterns in 
two-dimensional kinematic model for biological 
groups, SIAM J. Appl. Math. 65(1), 152-174 (2004) 
J.A. Fax, R.M. Murray: Information flow and co- 
operative control of vehicle formations, IEEE Trans. 
Autom. Contr. &9(9), 1465-1476 (2004) 

J.A. Marshall, M.E. Broucke, B.R. Francis: For- 
mations of vehicles in cyclic pursuit, IEEE Trans. 
Autom. Contr. 49(11), 1963-1974 (2004) 

S.S. Ge, C.-H. Fua: Queues and artificial poten- 
tial trenches for multirobot formations, IEEE Trans. 
Robot. 21(4), 646-656 (2005) 

P. Tabuada, G. Pappas, P. Lima: Motion feasibility 
of multi-agent formations, IEEE Trans. Robot. 21(3), 
387-392 (2005) 

G. Antonelli, S. Chiaverini: Kinematic control of 
platoons of autonomous vehicles, IEEE Trans. 
Robot. 22(6), 1285-1292 (2006) 

J. Fredslund, M.J. Matari¢: A general algorithm for 
robot formations using local sensing and minimal 
communication, IEEE Trans. Robot. Autom. 18(5), 
837-846 (2002) 

L.E. Parker: ALLIANCE: An architecture for fault 
tolerant, cooperative control of heterogeneous 
mobile robots, Proc. IEEE/RSJ/GI Int. Conf. Intell. 
Robot. Syst. (IEEE, Munich 1994) pp. 776-783 

B. Donald, J. Jennings, D. Rus: Analyzing teams 
of cooperating mobile robots, Proc. IEEE Int. Conf. 
Robot. Autom. (IEEE, 1994) pp. 1896-1903 

S. Sen, M. Sekaran, J. Hale: Learning to coordi- 
nate without sharing information, Proc. AAAI (AAAI, 
Seattle 1994) pp. 426-431 

B. Tung, L. Kleinrock: Distributed control methods, 
Proc. 2nd Int. Symp. High Perform. Distrib. Comput. 
(1993) pp. 206-215 

Z.-D. Wang, E. Nakano, T. Matsukawa: Cooper- 
ating multiple behavior-based robots for object 
manipulation. (IEEE, Munich) pp. 1524-1531 

P.J. Johnson, J.S. Bay: Distributed control of sim- 
ulated autonomous mobile robot collectives in 
payload transportation, Auton. Robot. 2(1), 43-63 
(1995) 

D. Rus, B. Donald, J. Jennings: Moving furniture 
with teams of autonomous robots, Proc. IEEE/RSJ 
Int. Conf. Intell. Robot. Syst. (Pittsburgh 1995) 
pp. 235-242 

F. Hara, Y. Yasui, T. Aritake: A kinematic analysis 


40.128 


40.129 


40.130 


40.131 


40.132 


40.133 


40.134 


40.135 


40.136 


40.137 


40.138 


40.139 


40.140 


40.141 


40.142 


40.143 


of locomotive cooperation for two mobile robots 
along a general wavy road, Proc. IEEE Int. Conf. 
Robot. Autom. (IEEE, Nagoya 1995) pp. 1197-1204 

J. Sasaki, J. Ota, E. Yoshida, D. Kurabayashi, T. Arai: 
Cooperating grasping of a large object by multiple 
mobile robots, Proc. IEEE Int. Conf. Robot. Autom. 
(IEEE, Nagoya 1995) pp. 1205-1210 

C. Jones, MJ. Mataric Automatic synthesis of 
communication-based coordinated multi-robot 
systems, Proc. IEEE/RJS Int. Conf. Intell. Robot. Syst. 
(IEEE, Sendai 2004) pp. 381-387 

Z. Wang, V. Kumar: Object closure and manipula- 
tion by multiple cooperating mobile robots, Proc. 
IEEE Int. Conf. Robot. Autom. (IEEE, 2002) pp. 394- 
399 

L.E. Parker: Cooperative robotics for multi-target 
observation, Intell. Autom. Soft Comput. 5(1), 5-19 
(1999) 

S. Luke, K. Sullivan, L. Panait, G. Balan: Tunably 
decentralized algorithms for cooperative target 
observation, Proc. 4th Int. Joint Conf. Auton. 
Agents Multiagent Syst., The Netherlands (ACM, 
New York 2005) pp. 911-917 

S.M. LaValle, H.H. Gonzalez-Banos, C. Becker, J.- 
C. Latombe: Motion strategies for maintaining 
visibility of a moving target, Proc. IEEE Int. Conf. 
Robot. Autom. (IEEE, Albuquerque 1997) pp. 731-736 
A. Kolling, S. Carpin: Multirobot cooperation for 
surveillance of multiple moving targets - a new 
behavioral approach, Proc. IEEE Int. Conf. Robot. 
Autom. (IEEE, Orlando 2006) pp. 1311-1316 

B. Jung, G. Sukhatme: Tracking targets using mul- 
tiple mobile robots: The effect of environment 
occlusion, Auton. Robot. 13(3), 191-205 (2002) 

Z. Tang, U. Ozguner: Motion planning for multi- 
target surveillance with mobile sensor agents, IEEE 
Trans. Robot. 21(5), 898-908 (2005) 

D. Grossman: Traffic control of multiple robot 
vehicles, IEEE J. Robot. Autom. 4, 491-497 
(1988) 

P. Caloud, W. Choi, J.-C. Latombe, C. Le Pape, 
M. Yim: Indoor automation with many mobile 
robots, Proc. IEEE Int. Workshop Intell. Robot. Syst. 
(IEEE, Tsuchiura 1990) pp. 67-72 

H. Asama, K. Ozaki, H. Itakura, A. Matsumoto, 
Y. Ishida, |. Endo: Collision avoidance among 
multiple mobile robots based on rules and com- 
munication, Proc. IEEE/RJS Int. Conf. Intell. Robot. 
Syst. (IEEE, 1991) 

S. Yuta, 9. Premvuti: Coordinating autonomous and 
centralized decision making to achieve cooperative 
behaviors between multiple mobile robots, Proc. 
IEEE/RSJ Int. Conf. Intell. Robot. Syst. (IEEE, Raleigh 
1992) pp. 1566-1574 

J. Wang: Fully distributed traffic control strategies 
for many-AGV systems, Proc. IEEE Int. Workshop 
Intell. Robot. Syst. (IEEE, 1991) pp. 1199-1204 

J. Wang, G. Beni: Distributed computing problems 
in cellular robotic systems, Proc. IEEE Int. Workshop 
Intell. Robot. Syst. (IEEE, Tsuchiura 1990) pp. 819- 
826 

H. Kitano, M. Asada, Y. Kuniyoshi, I. Noda, 
E. Osawa, H. Matasubara: RoboCup: A challenge 
problem of Al, Al Mag. 18(1), 73-86 (1997) 


第 40 章 多 机 器 人 系统 


397 


40.144 


40.145 


40.146 


40.147 


40.148 


40.149 


40.150 


40.151 


40.152 


40.153 


H. Kitano, S. Tadokoro: RoboCup rescue: A grand 
challenge for multiagent and intelligent systems, 
Al Mag. 22(1), 39-52 (2001) 

B. Browning, J. Bruce, M. Bowling, M. Veloso: STP: 
Skills, tactics and plays for multi-robot control in 
adversarial environments, IEEE J. Contr. Syst. Eng. 
219, 33-52 (2005) 

M. Veloso, P. Stone, K. Han: The CMUnited-97 
robotic soccer team: Perception and multia- 
gent control, Robot. Auton. Syst. 29(2-3), 133-143 
(1999) 

T. Weigel, J.-S. Gutmann, M. Dietl, A. Kleiner, 
B. Nebel: CS Freiburg: coordinating robots for suc- 
cessful soccer playing, IEEE Trans. Robot. Autom. 
5(18), 685-699 (2002) 

P. Stone, M. Veloso: Task decomposition, dynamic 
role assignemnt, and low-bandwidth commu- 
nicaiton for real-time strategic teamwork, Artif. 
Intell. 110(2), 241-273 (1999) 

C. Candea, H.S. Hu, L. locchi, D. Nardi, M. Piag- 
gio: Coordination in multi-agent Robocup teams, 
Robot. Auton. Syst. 36(2), 67-86 (2001) 

L.E. Parker: Current research in multirobot teams, 
Artif. Life Robot. 7(2-3), 1-5 (2005) 

K.R. Baghaei, A. Agah: Task allocation and 
communication methodologies for multi-robot 
systems, Intell. Autom. Soft Comput. 9, 217-226 
(2003) 

T. Balch, L.E. Parker: Guest editorial, special is- 
sue on heterogeneous multi-robot systems, Auton. 
Robot. 8(3), 207-208 (2000) 

M. Dorigo, E. Sahin: Guest editorial, special issue 
on swarm robotics, Auton. Robot. 17(2-3), 111-113 
(2004) 


40.154 


40.155 


40.156 


40.157 


40.158 


40.159 


40.160 


40.161 


40.162 


40.163 


40.164 


M. Veloso, D. Nardi: Special issue on multirobot 
systems, Proc. IEEE 94, 1253-1256 (2006) 

T. Balch: Taxonomies of multi-robot task and 
reward. In: Robot Teams: From Diversity to Poly- 
morphism, ed. by T. Balch, L.E. Parker (A K Peters, 
Natick 2002) 

L.E. Parker, G. Bekey, J. Barhen (Eds.): Distributed 
Autonomous Robotic Systems 4 (Springer, Berlin, 
Heidelberg 2000) 

H. Asama, T. Arai, T. Fukuda, T. Hasegawa 
(Eds.): Distributed Autonomous Robotic Systems 5 
(Springer, Berlin, Heidelberg 2002) 

A. Schultz, L.E. Parker (Eds.): Multi-Robot Systems: 
From Swarms to Intelligent Automata (Kluwer, 
Dordrecht 2002) 

A. Schultz, L.E. Parker, F. Schneider (Eds.): 
Multi-Robot Systems Volume Il: From Swarms to 
Intelligent Automata (Kluwer, Dordrecht 2003) 

E. Sahin, W.M. Spears (Eds.): Swarm Robotics: 
SAB 2004 International Workshop (Springer, Berlin, 
Heidelberg 2004) 

LE. Parker, F. Schneider, A. Schultz (Eds.): 
Multi-Robot Systems Volume lll: From Swarms 
to Intelligent Automata (Kluwer, Dordrecht 
2005) 

R. Alami, R. Chatila, H. Asama (Eds.): Distributed 
Autonomous Robotic Systems 6 (Springer, Berlin, 
Heidelberg 2006) 

M. Gini, R. Voyles (Eds.): Distributed Autonomous 
Robotic Systems 7 (Springer, Berlin, Heidelberg 
2006) 

T. Balch, L.E. Parker (Eds.): Robot Teams: From 
Polymorphism to Diversity (A K Peters, Natick 2002) 


$413 LR LA A 


Vijay Kumar, Daniela Rus, Gaurav S. Sukhatme 


HER 详 


本 章 讨 论 网 络 机 器 人 ， 多 机 融 人 通过 网 络 通信 
进行 协调 与 合作 ， 共 同 完成 一 个 指定 的 任务 。 本 章 
是 对 此 领域 的 概述 ， 重 点 强调 最 新 的 研究 成 果 以 及 
研究 所 面临 的 挑战 。 多 机 器 人 产生 新 的 功能 ， 通 信 
网 络 产生 新 的 方法 和 解决 方案 ， 而 这 对 于 只 有 感知 
和 控制 的 机 器 人 来 说 是 困难 的 。 通 信使 系统 产生 新 
的 控制 和 感知 能 力 (例如 获得 机 右 人 系统 感知 范 
届 以 外 的 信息 )。 相 反 ， 控 制 可 以 为 某 些 问题 提供 
解决 方案 ， 而 这 些 问题 对 不 可 移动 的 机 器 人 系统 是 
很 困难 的 〈 例 如 : 定位 问题 ) 。 第 41. 1 节 为 该 领 
域 下 了 定义 ， 检 测 了 网 络 在 机 器 人 协作 中 的 益处 ， 
并 讨论 了 它 的 应 用 。 第 41. 2 节 精 选 了 几 个 基于 网 
络 机 器 人 技术 的 案例 ， 并 讨论 了 在 本 领域 的 应 用 洪 
力 。 第 41.3 节 讨论 了 在 控制 、 通 信和 感知 的 交叉 
领域 所 面临 的 挑战 。 第 41. 4 节 定 义 了 一 个 在 41.5 ~ 


41.1 概述 


“网 络 机 器 人 ”这 一 术语 是 指 在 网 络 通信 的 协作 
下 多 个 机 器 人 一 起 运作 来 完成 一 项 特殊 的 任务 。 各 实 


41. 8 节 中 用 到 的 网 络 机 絮 人 系统 控制 模型 ， 用 来 
说 明 研 究 面临 的 具体 问题 和 机 遇 ， 这 些 问题 和 机 遇 


是 由 通信 、 控 制 和 感知 共同 作用 而 产生 的 。 
41.1 概述 HH 398 
41.2 技术 发 展 水 平和 潜力 .pp 400 
41.3 研究 面临 的 挑战 402 
41.4 控制 403 
4.5 控制 通信 403 
41.6 感知 通信 404 
4.7 感知 控制 405 
418 通信 控制 Ne 406 
4.9 结论 与 扩展 阅读 cree crete cece cence eee ee ees 407 
参考 文献 407 
为 大 众 产生 有 价值 的 资源 来 支持 研究 、 教 育 和 公众 
意识 。 


第 二 ， 自 动机 器 人 ， 在 对 它 的 操作 过 程 中 机 器 人 
和 传 感 顺 通过 网 络 交换 数据 。 此 项 系统 中 ， 在 允许 它 
们 通过 长 距离 的 沟通 来 协调 各 项 活动 的 情况 下 ， 传 感 


体 之 间 的 通信 是 合作 (和 协调 ) 的 基础 ， 因 此 在 网 
络 机 器 人 的 通信 网 络 中 有 一 个 核心 作用 ， 网 络 机 器 人 
也 可 能 涉及 固定 传感器 、 和 能 入 式 计 算 机 和 人 类 用 户 的 
协调 与 合作 。 网 络 机 器 人 的 主要 特征 是 具备 执行 单个 
机 器 人 或 相互 之 间 无 协调 的 多 个 机 器 人 所 不 能 完成 的 
任务 的 能 力 。 
IEEE 网 络 机 器 人 技术 委员 会 采用 了 以 下 对 网 络 
机 器 人 的 定义 : 
网 络 机 器 人 就 是 与 通信 网 络 (如 局 域 网 ) 连接 
的 机 器 人 装置 。 网 络 可 以 是 有 线 或 者 无 线 ， 以 多 样 的 
协议 为 根据 ， 如 传输 控制 协议 、 用 户 数据 协议 或 
802. 11。 许 多 新 的 应 用 正在 被 开发 ， 从 自动 化 领域 到 
探索 工程 。 网 络 机 器 人 分 为 两 种 : 
第 一 ， 遥 探 机器人， 在 对 它 的 操作 过 程 中 执行 
者 发 送 命令 并 通过 网 络 接受 反馈 ， 这样 的 系统 通过 


器 网 络 扩展 机 器 人 的 有 效 感应 范围 ， 不 需要 去 组 合 配 
置 感应 、 启 动 、 计 算 这 些 程序 。 一 个 很 大 的 挑战 是 开 
发 一 个 科学 基地 使 通信 、 感 知 和 控制 相 结合 ， 从 而 使 
这 些 新 的 能 力 产 生效 力 。 

网 络 机 器 人 的 此 项 定义 也 包括 了 分 散 式 系统 的 第 
三 分 类 、 传 感 网 络 的 自然 进化 的 移动 传 感 网 络 ， 机 带 
人 网 络 允 许 机 器 人 更 有 效 地 测量 空间 和 时 间 的 分 布 现 
象 。 机 器 人 反 过 来 可 以 部 署 、 修 复 和 维护 传感器 网 络 
以 增加 它 的 寿命 和 功用 。 本 章 的 重点 是 自动 网 络 机 
AS 
CA SU HE DI AA P RATE ZEA TEH Bi Ah 
不 在 ， 日 益 增 多 的 无 线 点 对 点 网 络 或 即 插 即 用 的 有 线 
网 络 已 经 随处 可 见 。 用 户 通过 与 府 入 式 电脑 和 传感器 
互动 去 执行 任务 ， 从 监控 (如 对 某 一 项 因素 操作 过 
程 的 监督 和 对 一 个 建筑 物 的 监督 ) 到 控制 (运作 由 
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传感器 、 制 动 器 和 物资 搬运 设备 组 成 的 生产 流水 
线 ) 。 在 这 些 情 形 中 ， 用 户 、 艇 入 式 电 脑 和 传感器 并 
不 是 并 列 的 ， 它 们 的 协作 和 沟通 通过 网 络 来 实现 。 网 
络 机 器 人 把 它 的 视野 拓展 到 多 个 机 如 人 ， 它 们 在 不 同 
的 环境 下 起 作用 并 执行 任务 ， 这 些 需要 它们 与 其 他 机 
器 人 相互 协调 ， 与 人 类 相互 合作 ， 依 据 来 自 多 个 传 感 
器 的 信息 而 起 作用 。 

图 41. 1 展示 了 来 源 于 实验 室 和 工业 领域 的 原型 
概念 。 在 这 些 例 子 中 ， 一 个 独立 的 机 器 人 或 者 机 需 
人 模块 可 以 合作 来 执行 单个 机 器 人 (或 机 器 人 模 
KR) 不 能 单独 完成 的 任务 。 机 融 人 可 以 自动 结合 执 
行 运动 任务 〈 见 图 41.2) 和 操作 任务 ， 这 些 任务 由 
单个 机 器 人 是 无 法 完成 的 ， 需 要 一 个 有 特殊 用 途 的 
更 大 的 机 器 人 来 完成 。 它 们 可 以 利用 并 行 处 理 的 固 
有 效率 ， 相 互 合作 来 执行 探索 和 勘测 任务 。 它 们 也 
可 以 执行 需要 协调 来 完成 的 独立 任务 ， 制 造 业 中 的 
例子 比如 夹具 和 焊接 。 


图 41.1 a) 小 模块 UL 可 以 自动 地 通过 联系 和 传输 信 

息 来 执行 运动 任务 b) 机 器 人 手臂 ULT 可 以 通过 移动 来 

做 家 务 c) 成 群 的 机 器 人 (8) 可 以 用 来 探索 未 知 的 环境 
d ) 工业 机 器 人 可 以 在 焊接 作业 中 进行 合作 


除了 可 以 执行 单个 机 器 人 不 能 执行 的 任务 以 外 ， 
网 络 机 器 人 还 有 提高 效率 的 功能 。 网 络 可 以 使 机 器 人 
获取 感知 范围 以 外 的 信息 。 机 器 人 数量 的 增多 原则 上 
可 以 更 快 地 执行 任务 ， 如 搜索 和 绘图 任务 。 通 过 部 署 
多 个 机 器 人 进行 平行 操作 但 以 合作 的 方式 可 以 实现 加 
速生 产 运作 。 

使 用 网 络 机 器 人 的 另外 一 个 优势 是 拥有 连接 和 利 
用 机 器 人 自身 移动 特性 的 能 力 。 移 动 式 机 器 人 可 以 对 
位 于 远 处 的 移动 式 机 器 人 所 感应 到 的 信息 做 出 反应 。 


图 41.2 NIS ARR UU 可 以 被 重新 配置 为 
不 同 的 模块 而 转型 成 不 同 的 运动 系统 


a) 一 个 轮 状 的 滚动 系统 b) 一 个 蛇 形 的 波状 运动 系统 
e) 一 个 四 肢 的 步行 系统 


工业 机 器 人 可 以 把 它们 的 端 部 操纵 装置 应 用 到 生产 流 
水 线 逆向 操作 的 新 部 位 。 用 户 可 以 通过 网 络 使 用 位 于 
WOM AY LAE o 

网 络 机 器 人 的 这 些 能 力 允 许 设计 中 出 现 失误 。 
如 果 机 器 人 可 以 使 用 网 络 实现 灵活 地 重新 配置 ， 
它们 则 能 更 大 限度 地 承受 机 器 人 操作 失误 。 这 种 
情况 在 拥有 由 多 个 网 关 、 路 由 器 和 计算 机 提供 的 
容错 系统 的 因特网 中 是 存在 的 (虽然 因特网 在 其 
他 方面 没有 那么 强大 ) 。 类 似 地 ， 那 些 可 即 插 即 用 
的 机 絮 人 可 以 通过 灵活 操作 转换 而 提供 一 个 强大 
的 操作 环境 。 

最 后 ， 网 络 机 器 人 能 够 通过 将 具有 互补 效益 
的 各 部 分 组 件 连接 在 一 起 而 产生 巨大 的 协同 作用 ， 
它 以 整体 来 工作 会 比 各 个 组 件 分 别 工作 的 效用 
要 大 。 

网 络 机 器 人 的 应 用 非常 广泛 。 美 国 军 方 日 党 
部 署 的 无 人 驾驶 车 辆 ， 它 们 是 根据 由 其 他 无 人 轰 
驶 车 辆 收集 的 情报 ,或 者 是 自动 地 远程 重新 配置 
程序 。 而 对 太空 卫星 的 部 署 通常 由 宇航 员 用 航天 
飞机 机 械 臂 来 操作 ， 需 要 航天 飞机 所 载 的 复杂 仪 
器 、 地 面 工 作 站 的 操作 员 、 航 天 飞机 机 辟 和 航天 
飞机 的 使 用 者 的 相互 协调 。 家 用 电器 如 今 也 将 传 
感 串 包括 在 内 ， 并 实现 了 网 络 化 。 由 于 家 庭 和 个 
人 机 器 人 的 使 用 越 来 越 普 及 ， 当 我 们 看 到 机 器 人 
在 与 用 户 进 行 合 作 时 用 到 传感器 和 家 用 电器 进行 
工作 也 就 不 足 为 奇 了 。 网 络 机 器 人 很 可 能 会 成 为 
环境 观测 十 分 重要 的 组 成 部 分 ， 大量 的 环境 监测 
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系统 不 能 使 用 整体 基础 设施 ， 并 期 望 能 建立 成 为 
分 散 式 的 网 络 机 器 人 系统 。 


41.2 技术 发 展 水 平和 潜力 


2003 年 成 立 于 日 本 的 网 络 机 器 人 论坛 引 佑 计 ， 
到 2013 年 网 络 机 器 人 行业 的 产值 会 达到 2000 亿 
美元 以 上 ， 比 应 用 于 制造 业 的 工业 机 器 人 市 场 产 
值 还 要 大 。 这 种 增长 是 广泛 的 ， 涵 盖 了 很 多 行业 。 
此 行业 和 与 传 感 网 络 有 联系 的 行业 之 间 有 很 密切 
的 联系 。 就 商品 化 和 市 场 价 值 来 说 ， 预 计 传 感 网 
络 行业 已 经 有 了 显著 增长 ,机 器 人 网 络 除了 
允许 传感器 具有 移动 性 并 且 人 允许 传感器 根据 所 获 
信息 来 调整 地 理 分 布 这 两 方面 存在 不 同 外 ， 它 和 
传 感 网 络 是 很 相似 的 。 

由 机 器 人 、 肯 入 式 计 算 机 、 激 发 器 和 传感器 组 成 
的 系统 在 民用 、 防 护 和 制造 方面 具有 巨大 的 潜力 。 自 


图 41.3 蚂蚁 可 以 成 群 结 队 地 合作 来 搬运 物体 ， 它 们 
无 需 识别 同伴 身份 也 无 需 采 取 集 中 协调 方式 


的 重要 性 和 潜在 的 影响 。 

制造 业 一 直 是 依靠 传感器 、 制 动 器 、 材 料 处 理 设 
备 和 机 器 人 之 间 的 集成 而 发 展 的 。 今 天 ， 公 司 发 现 通 
过 无 线 网 络 把 网 络 机 器 人 和 传感器 与 现 有 的 机 器 人 进 


然 界 为 得 以 成 为 可 能 的 事情 提供 依据 ”” 。 我 们 可 以 


行 联网 更 容易 实现 现 有 基础 设施 的 重新 配置 。 机 器 人 


在 有 数 米 长 的 物体 中 发 现 长 度 只 有 几 徽 米 有 机 体 具 有 
群体 行为 。 简 单 的 动物 能 通过 传感器 和 制动器 去 行使 
简易 的 行为 ， 但 是 进行 交流 并 感应 到 近邻 的 存在 从 而 
去 实施 复杂 的 紧急 行为 ， 对 航海 、 砚 食 、 捕 猎 、 筑 
梨 、 生 存 和 增长 这 些 方面 来 说 是 根本 。 如 图 41.3 所 
示 ， 相 对 较 小 的 智能 体 可 以 操控 尺度 明显 更 大 的 物 
体 ， 并 通过 与 相对 更 加 简单 的 个 体 行为 合作 来 实现 有 
效 负荷 。 当 这 些 智能 体 换 作 大 量 的 机 器 人 和 硕大 的 物 
体 时 ， 各 智能 体 之 间 的 协调 是 完全 分 散 开 来 的 ”” 。 
个 体 之 间 彼 此 并 不 能 相互 识别 ， 换 句 话 说， 就 是 每 个 
机 器 人 并 没有 任何 标签 和 标志 。 作 业 小 组 中 的 智能 体 
的 数量 并 没有 被 明确 编码 。 各 智能 体 都 是 相同 的 ， 这 
使 得 系统 的 鲁 棒 性 和 模块 性 得 以 保证 。 他 们 彼此 之 间 
很 少 会 相互 沟通 ， 即 使 有 的 话 也 只 是 和 近邻 智能 体 之 
间 的 沟通 。 而 且 ， 最 佳 的 集体 协调 模式 也 许 就 是 大 规 
模 的 相互 依赖 。 针 对 黄蜂 的 研究 提供 了 有 力 证 据 ， 证 
明 小 规模 群体 之 间 存 在 集体 协调 ， 而 更 大 群体 则 采取 
分 散 式 的 协调 方式 ”“”。 以 上 这 些 特征 都 和 网 络 机 器 
人 息息相关 。 

生物 学 已 经 向 我 们 说 明了 彼此 不 明 身份 的 个 体 中 
(例如 : 昆虫 和 乌 类 进行 群体 行为 时 ) 的 分 散 行为 可 
以 非常 容易 地 实施 看 似 聪明 的 群体 行为 。 相 似 地 ， 网 
络 机 器 人 之 间 很 可 能 可 以 相互 交流 与 合作 ， 虽 然 单个 
机 器 人 可 能 不 是 很 复杂 ， 但 是 为 网 络 机 器 人 提供 一 系 
列 的 智能 行为 (超越 机 器 人 的 智力 水 平 ) 还 是 有 可 
能 的 。 

从 以 下 事例 中 我 们 可 以 很 明显 地 看 出 网 络 机 器 人 


在 操作 过 程 中 如 焊接 和 加 工时 可 进行 彼此 互动 ， 在 完 
成 装配 和 材料 处 理 任务 时 与 人 类 相互 合作 ， 机 器 人 在 
这 些 方面 的 功能 呈 增 加 的 趋势 。 工 作 单元 由 多 个 机 器 
人 、 许 多 传感器 和 控制 器 、 自 动 导 引 车 以 及 一 两 个 起 
监督 作用 的 操作 人 员 组 成 。 然 而 ， 在 这 些 单 元 的 最 内 
部 ， 网 络 化 操作 机 器 人 在 结构 化 的 环境 下 进行 操作 ， 
在 这 个 环境 中 ,配置 和 (或 ) 操作 环境 很 少 会 
变化 。 

在 机 器 人 领域 的 应 用 方面 ， 网 络 化 操作 机 器 
人 受到 越 来 越 多 的 重视 ， 其中， 采矿 行业 就 是 一 
个 例子 : 就 像 在 制造 行业 中 一 样 ， 操 作 条 件 往 往 
难以 令 人 满意 ， 而 且 任 务 都 是 重复 性 的 。 但 是 ， 
这 些 应 用 更 少 结构 化 ， 并 且 操 作 人 员 起 着 更 重要 
的 作用 。 

在 卫生 保健 行业 ， 网 络 使 卫生 保健 专业 人 员 与 病 
人 、 其 他 专业 人 才 、 昂 贵 的 诊断 仪器 进行 互动 ， 并 在 
未 来 可 以 和 外 科 手 术 机 器 人 进行 互动 。 预 计 ， 远 程 医 
疗 为 将 代替 当今 独立 医疗 设备 的 远程 网 络 机 器 人 设备 
提供 了 主要 的 增长 动力 。 

现在 已 经 有 许多 商业 产品 ， 尤 其 是 在 日 本 ， 机 器 
人 可 以 通过 与 手机 沟通 来 进行 编程 。 例 如 ， 由 富士 通 
开发 的 MARON 机 器 人 让 使 用 者 给 他 们 的 机 器 人 拨 
号 ， 并 指示 它 来 进行 简单 的 任务 ， 包 括 用 手机 把 照片 
返回 给 用 户 。 事 实 上 ， 这 些 机 器 人 会 与 家 里 的 其 他 传 
感 带 和 驱动 带 互 动 一 一 配 有 蓝牙 卡 和 驱动 器 的 开门 者 
以 及 计算 机 控制 的 照明 、 微 波 炉 、 洗 碗 机 。 事 实 上 ， 
网 络 机 器 人 论坛 下 引 已 经 为 固定 传感器 和 驱动 器 如 何 


m 
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与 其 他 机 器 人 在 家 庭 和 商业 设置 方面 进行 互动 设 定 了 
标准 。 

环境 监测 是 网 络 机 器 人 的 一 个 关键 应 用 。 通 过 利 
用 移动 通信 ， 机 器 人 的 基础 设施 允许 在 生态 监测 的 各 
个 方面 进行 前 所 未 有 的 尺度 观测 和 数据 收集 。 这 是 对 
环境 监管 政策 〈 例 如 ， 清 洁 的 空气 和 水 的 法 律 ) 以 
及 一 个 新 的 科学 发 现 有 着 十 分 重要 的 意义 ， 例 如 ， 它 
有 可 能 有 助 于 获得 海洋 中 的 盐 度 梯度 图 、 温 度 图 和 在 
森林 中 湿度 变化 情况 以 及 空气 和 水 在 不 同 生态 系 
统 趾 中 的 化 学 成 分 。 除 了 移动 传感器 网 络 ， 它 也 
可 以 使 用 机 器 人 部 署 传感器 和 检索 来 自传 感 器 的 信 
息 。 当 通信 允许 协调 控制 和 信息 聚合 时 ， 移 动 平台 
许 同 一 个 传感器 来 收集 数据 。 这 种 情况 的 例子 包括 水 
中 监测 和， 陆地 监测 寺中 和 土壤 监测 中 DT 
发 水 下 网 络 平台 人 们 付出 了 很 多 努力 | S 
网 络 和 机 器 人 设备 已 经 由 于 水 产品 检测 所 的 需要 
而 得 以 开发 和 发 展 ， 获 得 了 关于 浮游 生物 时 空 分 布 的 
高 分 辨 率 信息 和 伴随 而 来 的 环境 参数 。 伦 斯 勒 理工 学 
院 (RPI) 的 河 网 项 目 人 中 重点 是 研发 监测 河流 的 生 
态 系统 的 机 器 人 传 感 网 络 。 最 近 加 州 大 学 洛杉矶 分 校 
(UCLA), 、 南 加 州 大 学 (USC), 、 加 州 大 学 里 弗 赛 得 
分 校 和 加 州 大 学 关于 网 络 化 信息 机 械 系 统 工程 
都 已 在 重点 研发 机 器 人 网 络 ， 用 来 监测 森林 树冠 ， 从 
而 为 树冠 建 模 和 地 下 增长 状况 提供 数据 。 有 人 把 网 络 
机 器 人 mini- rhizotronst" ”部署 在 森林 监测 树 根 的 生 
长 状况 。 

在 国防 工业 ,一 些 国家 ， 如 美国 已 经 在 网 络 化 
概念 和 地 理性 分 散 资 产 方面 投入 巨 资 。 无 人 驾驶 飞 
行 器 〈 像 “捕食 者 号 ”) ， 实 行 的 是 远程 操作 。 从 
“捕食 者 号 ”上 的 传感器 发 出 的 信息 会 对 处 在 不 同 
远程 位 置 上 的 其 他 车 辆 和 武器 系统 进行 部 署 ， 并 人 允 
许 处 在 第 三 位 置 的 指挥 员 来 指挥 和 控制 这 些 资产 。 
美国 军 方正 在 从 事 大 规模 未 来 战斗 系统 计划 ， 开 发 
以 网 络 为 中 心 的 方法 来 部 署 自主 车 辆 。 在 现代 战争 
中 以 网 络 为 中 心 的 战术 模式 创造 了 国防 和 国土 安全 
的 网 络 机 需 人。 虽然 网 络 机 器 人 已 经 开始 执行 ， 但 
目前 的 方法 仅 限于 由 用 户 指挥 的 单一 车 辆 或 传 感 系 
统 。 然 而 ， 它 需要 很 多 的 操作 人 员 (在 2~10 人 之 
间 ， 视 系统 的 复杂 性 而 定 ) 来 部 署 与 无 人 驾驶 飞行 
器 一 样 复杂 的 系统 。“ 捕 食 者 号 ”无 人 轰 驶 飞行 器 
(UAV) 从 战术 控制 站 开始 运行 ， 此 站 也 许 会 位 于 
航空 母 舰 上 ， 有 3 ~ 10 名 船员 。 

然而 ， 最 终 的 目的 则 是 确保 单独 的 用 户 能 够 部 署 
无 人 驾驶 的 空中 、 地 面 、 水 面 和 水 下 运载 器 。 最 近 有 
一 些 关 于 多 机 器 人 使 用 的 演示 ， 它 通过 探索 城市 环 


Jg ”和 建筑 物 内 部 ”| 来 探测 和 跟踪 入 侵 者 ， 
并 把 以 上 所 获 信息 传达 给 远程 操作 者 。 这 些 例子 表 
明 ， 使 用 现成 的 802. 11b 无 线 网 络 来 部 署 网 络 机 器 人 
的 运行 以 及 拥有 一 个 由 单一 操作 者 来 进行 远程 操作 和 
执行 任务 的 团队 是 有 可 能 的 。 一 个 城市 中 有 很 多 车 辆 
的 项 目 例 子 如 图 41.4 所 示 ; 一 个 室内 环境 中 有 很 多 
车 辆 的 项 目 例子 如 图 41.5 所 示 ， 此 时 机 器 人 可 绘制 
出 环境 地 图 ， 并 实行 自行 部 署 形成 一 个 传 感 网 络 以 探 
WARE. 


图 41.4 一 个 操作 者 根据 城市 环境 中 的 指挥 和 控制 车 辆 

的 指令 来 指挥 空中 网 络 和 地 面 车 辆 ， 以 用 来 侦察 和 勘 

测 ， 这 是 在 美国 宾夕法尼亚 大 学 ， 佐 治 亚 理工 大 学 和 南 
加 州 大 学 NS) 得 到 证 实 的 


图 41.5 根据 美国 国防 部 高 级 研究 计划 局 SDR 计划 ， 

由 来 自 南 加 州 大 学 、 田 纳西 大 学 和 科学 应 用 与 国际 公司 

(SAIC) 的 研究 团队 进行 验证 筹划 ， 并 由 网 络 化 机 器 人 
2819) 对 入 侵 者 进行 检测 


许多 研究 项 目 是 通过 观察 自然 界 中 的 聚集 行为 来 
探究 群体 行为 和 集体 智能 。 例 如 ， 欧 盟 (EU) AJL 
个 欧盟 范围 内 的 关于 集体 智能 和 群体 智慧 的 协调 项 
目 。 在 卡尔 斯 鲁 厄 的 LPEN HU 和 在 洛桑 联邦 理 
工学 院 王 六 的 植物 群 项 目 是 群体 智慧 的 合子。 进行 
分 析 和 系统 体系 结构 的 实验 室 (LAAS) 有 一 个 机 器 
人 和 人 工 智能 的 强势 群体 。 此 群体 在 基础 和 对 多 个 机 
器 人 系统 的 应 用 研究 方面 已 经 拥有 了 悠久 的 历史 。 多 
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移动 式 和 分 布 式 机 器 人 技术 


重 无 人 驾驶 车 辆 的 综合 应 用 ， 如 地 图 测绘 和 消防 的 说 
明 见 参考 文献 [41.25], 。 最 近 美 国 的 一 个 多 所 大 学 


变 。 不 仅 网 络 拓扑 结构 是 动态 的 ， 而 且 机 咒 人 的 行 
为 也 会 随 着 拓扑 结构 的 变化 而 变化 。 要 预测 这 样 的 


E 


UT EXT PI KAEVE E TE RERIT 7 中 的 发 展 进行 
了 研究 。 像 这 样 的 一 些 项 目 正在 把 基本 概念 的 延展 性 
扩展 到 机 咒 人 、 传 感 顺 和 制动器 领域 。 


41.3 研究 面临 的 挑战 


虽然 网 络 机 器 人 在 制造 业 、 国 防 工 业 、 太 空 
探索 、 国 内 援助 、 民 用 基础 设施 这 些 方面 有 得 以 
成 功 应 用 的 体现 ， 但 是 还 存在 一 些 必 须 克 服 的 重 
大 挑战 。 

在 协调 多 个 自治 单元 及 让 它们 相互 合作 方面 的 问 
题 产生 了 在 通信 、 控 制 和 感知 的 交叉 点 方面 的 问题 。 
应 该 是 谁 向 谁 交 谈 ， 应 该 传递 什么 样 的 信息 以 及 怎样 
传达 ? 为 完成 任务 ， 每 个 单元 应 该 怎样 运作 呢 ? 团队 
的 成 员 们 怎样 去 获得 信息 呢 ? 整个 团队 又 该 怎样 集合 
信息 呢 ? 这 些 都 是 需要 在 控制 理论 、 认 知 和 网 络 方面 
获得 基本 进展 的 基本 问题 。 此 外 ， 由 于 人 类 是 网 络 的 
一 部 分 〈 如 在 互联 网 中 ) ， 我 们 必须 在 不 必 担 心 每 个 
机 器 人 的 特殊 性 的 情况 下 ， 为 多 人 能 够 嵌入 网 络 并 指 
挥 /控制 /操作 网 络 设计 一 种 有 效 方法 。 因 此 ， 研 究 面 
临 的 潜在 挑战 在 于 控制 理论 、 感 知 和 通信 /网 络 的 交 
XL, WE 41.6 所 示 。 


智能 社区 


图 41.6 网 络 化 机 器 人 平台 引出 了 在 控制 、 感 
知 、 和 通信 方面 面临 的 根本 挑战 ， 这 是 机 器 人 、 传 
感 器 网 络 和 人 工 智能 社区 的 兴趣 所 在 


值得 一 提 的 还 有 : 不 像 传 感 咒 、 计 算 机 或 机 器 
网 络 那样 要 在 固定 的 拓扑 结构 中 联网 在 一 起 ， 机 天 
人 网 络 是 动态 的 。 当 一 个 机 器 人 移动 时 ， 与 它 相 邻 
的 机 器 人 就 会 改变 ， 并且 它 与 环境 的 关系 也 会 变化 。 
因此 ， 它 获取 的 信息 和 它 执行 行动 的 情况 也 必须 改 


网 络 机 器 人 的 性 能 是 很 困难 的 ， 而 且 这 正 是 机 器 人 
网 络 在 部 署 网 络 之 前 必须 解决 的 分 析 性 问题 。 这 个 
变化 的 拓扑 结构 概念 不 可 避免 地 为 我 们 呈现 出 复杂 
的 数学 模型 。 传 统 上 ， 和 群体 行为 模型 建立 在 持续 的 
个 体 动 态 模 型 基础 上 ， 其 中 包括 与 邻居 的 本 地 交互 ， 
与 拥有 固定 一 组 邻居 的 控制 和 传 感 模型 。 虽 然 处 于 
个 体 单元 水 准 的 动力 学 可 以 用 微分 方程 适当 地 描述 
出 来 ,但 与 邻居 的 交互 最 好 是 通过 图 表 边 缘 值 表示 
出 来 。 建 模 、 分 析 和 控制 这 些 系统 都 需要 一 个 全 面 
的 理论 框架 和 新 的 代表 性 工具 。 需 要 用 结合 动力 系 
统 理论 的 新 型 数学 工具 、 切 换 系 统 、 离 散 数学 、 图 
论 和 计算 几何 来 解决 潜在 的 问题 。 为 了 解决 导航 中 
的 逆 问 题 一 一 一 种 控制 个 体 得 到 一 个 指定 总 议案 和 
团体 形态 以 及 对 积极 感知 和 覆盖 的 应 用 行为 ， 我 们 
需要 一 种 设计 方案 。41. 4 节 对 这 些 方 法 中 的 一 部 分 
进行 了 概述 。 

机 器 人 委员 会 已 经 广泛 地 研究 了 感知 方面 的 问 
题 。 然 而 ， 在 网 络 化 的 移动 传感器 平台 系统 中 的 感知 
问题 带 来 了 一 系列 的 挑战 。 例 如 ， 我 们 可 以 想到 在 佑 
计 网 络 状态 方面 存在 的 问题 。 对 状态 的 估计 需要 对 机 
器 人 状态 和 以 当地 有 限 范围 的 感官 信息 为 根据 的 环境 
状态 的 估计 。 在 一 个 m 维 的 配置 空间 中 对 n 个 车 辆 
进行 定位 需要 用 到 关于 OC (nm)") 的 计算 ,根据 算 
法 和 特定 领域 的 假设 ， 此 时 大 的 范围 是 介 于 3 和 6 之 
间 。 佑 计 方 面 的 问题 被 更 加 恶化 了 ， 因 为 并 不 是 所 有 
网 络 中 的 机 器 人 都 能 够 在 关键 时 刻 获 得 必要 的 信息 。 
在 表示 法 和 算法 的 发 展 方面 存在 着 一 些 深层 次 问题 ， 
41.6 节 对 此 进行 了 讨论 。 

耻 极 感知 所 2 的 范例 将 传感器 平台 控制 与 感知 
联系 在 一 起 ， 这 就 使 控制 理论 和 感知 处 于 同一 个 框架 
结构 内 。 将 这 种 模式 扩展 到 网 络 化 机 器 人 需要 把 分 布 
式 控 制 与 分 散 式 估计 合并 在 一 起 的 方法 。 为 了 实现 在 
邻居 中 为 自己 定位 ， 为 它们 的 邻居 定位 ， 以 及 识别 、 
定位 和 追踪 环境 中 的 特征 ， 机 器 人 是 可 以 移动 的 。 这 
些 问题 在 41.7 节 进 行 了 讨论 。 

如 前 所 述 ， 机 器 人 网 络 的 功能 是 以 通信 网 络 为 中 
心 的 。 但 是 ， 如 果 网 络 由 有 限 电源 的 发 射 器 和 接收 器 
的 移动 智能 体 组 成 ， 也 不 能 保证 所 有 的 智能 体 之 间 可 
以 互相 通信 。 和 静态 传感器 网 络 不 同 的 是 ， 网 络 机 器 
人 可 以 朝 彼此 相互 移动 ， 以 促进 沟通 和 密切 地 维持 通 
信 网 络 。41. 8 节 提 供 了 一 些 基 本 的 算法 问题 和 相关 
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41.4 控制 

单个 机 器 人 的 控制 对 机 器 人 网 络 的 性 能 和 范围 
至 关 重 要 的 。 事 实 上， 为 了 达到 提高 通信 性 
4.28,29) 、 定 位 (41.30.31) 、 信 息 集成 、 部 署 中 2 和 
在 其 他 任务 中 实现 覆盖 "的 目的 ， 运 动 协调 算 
法 就 应 运 而 生 了 。 移动 性 使 得 机 器 人 组 能 在 通信 、 
感知 或 任务 需要 的 支持 下 通过 进行 自我 定位 实现 自 
我 部 署 和 自我 组 织 。 例 如 ， 它 们 可 以 进行 重新 配置 ， 
以 保证 所 需 的 通信 带宽 、k 跳 连通 性 、 或 代数 连通 
性 ， 使 得 信息 能 够 从 一 个 机 器 人 传输 到 另 一 个 机 器 


ae Rn 


对 .…X" 一 JxT 来 定义 的 ， 此 地 图 的 图 表 边 缘 是 根 
据 多 个 智能 体 的 自然 接触 而 动态 形成 的 。 具 体 来 
Bi, Whe Nx N 的 相 邻 矩阵 , A^ CRI AT). 满足 如 
下 条 件 : 


ayn | eee (41.2) 


” 【0, 其 他 
智能 体 4, 有 对 自身 状态 和 邻近 智能 体 (如 AL) 
状态 的 估计 能 力 ， 这 些 佑 计 来 源 于 传 感 图 和 通信 图 边 
界 的 相关 信息 。 


RO =h(x;,z;) (41.3) 
式 中 ，2Z 表 示 通 过 遥感 或 通信 渠道 对 智能 体 4, 和 
A, 状态 的 测量 , h 是 智能 体 4, 所 用 的 评价 指标 。 需 


人 。 该 小 组 还 可 以 自我 组 织 来 定位 传感器 ， 以 覆盖 
所 需 区 域 和 适应 以 监测 活动 为 中 心 的 转移 。 对 传 感 
器 位 置 的 控制 还 支持 地 图 制作 、 目 标 和 事件 追踪 ， 
以 及 对 网 络 使 用 者 的 目标 导航 。 最 后 ， 移 动 性 可 以 
让 机 器 人 来 完成 诸如 导航 、 侦 察 、 运 输 以 及 搜索 和 
救援 任务 。 
给 定 一 组 移动 传感器 ， 我 们 希望 拥有 分 布 式 的 控 
制 功能 来 实现 我 们 所 期 望 的 整体 规范 。 因 此 ， 能 够 自 
主 决 定 群 体 成 员 的 必要 位 置 、 方 位 和 /或 群体 成 员 的 
分 布 情况 ， 和 他 们 完成 所 期 望 的 任务 的 动力 是 很 有 必 
要 的 。 从 较 低 要 求 来 说 ， 机 器 人 必须 能 够 使 用 来 自 通 
信 网 络 和 它们 自身 传感器 的 信息 获取 关于 空间 网 络 
(它们 的 近邻 及 与 周围 环境 的 关系 ) 的 局 部 估计 值 和 
原因 ， 然 后 使 用 适合 的 控制 策略 以 实现 预期 的 群体 计 
划 。 我 们 简要 概述 了 最 简易 的 数学 模型 ， 为 更 好 地 意 
识 到 潜在 的 挑战 ， 对 这 些 问 题 进行 系统 地 阐述 ， 是 很 
有 必要 的 。 
在 机 器 人 网 络 里 ， 我 们 有 多 个 智能 体 和 交叉 点 ， 
其 中 每 个 智能 体 都 是 一 个 物理 实体 ， 它 可 以 是 一 个 机 
器 人 ， 一 辆 带 有 制动器 和 传感器 的 车 、 一 个 传感器 平 
A (可 能 是 静态 的 ) 或 者 是 通信 中 继 节点 。 每 个 智 
能 体 4; 以 一 个 识别 符 ie ICZ 为 特征 ， 状 态 x, EX, C 
R”"， 控 制 输入 ue UCR， FAL: X, xU TXH 
以 下 动力 学 方程 的 条 件 : 
x =f (ku) (41.1) 
RA xh d 维 空 间 中 的 位 置 (和 方位 ) 六 和 速度 
F) 组 成 。m 22d .NOr) FIN‘ (r) 
与 上 r 相 邻 ， 分 别 就 通信 硬件 和 传感器 的 范围 和 领域 进 
行 了 定义 。 


nue, 


要 注意 的 是 ，2; 的 维度 可 能 小 于 n， 因 此 可 能 不 包 
含 关于 x; =x; -x 的 完整 信息 。 显 然 ， 由 7 = 7 一 7 
所 表示 的 相对 位 置 向 量 及 其 大 小 是 很 重要 的 量 ， 
可 能 需要 用 它们 来 对 生物 智能 体 和 人 工 智能 体 进 
行 估计 。 

最 后 ,4 可 以 对 n, 的 行为 进行 编码 ， 我 们 可 以 
通过 B, =B,, Boe. Ba 来 表示 ， 每 种 行为 BABE 
一 个 控制 量 ， 函 数 KK: R xX, 一 UV,。 可 以 指定 给 每 个 
智能 体 相 同 或 不 同 的 行为 。 每 种 行为 都 代表 了 一 系列 
不 同步 的 、 本 地 执行 的 计算 (用 于 控制 或 估计 )， 进 
行 这 些 计算 是 为 了 某 些 共 同 的 目的 。 处 理 器 在 计算 中 
所 用 的 数据 只 来 自 与 其 相 邻 的 处 理 器 。 此 外 ， 即 使 对 
一 个 特定 的 行为 任务 ， 与 每 个 处 理 器 邻近 的 处 理 器 也 
通常 会 随时 间 发 生 改 变 ， 因 为 处 理 器 在 集合 N* AM N 
中 是 不 断 在 移 进 移出 的 。 因 此 ， 对 这 类 系统 的 建 模 和 
分 析 方 法 需要 在 一 定 层次 上 将 图 论 和 动力 系统 论 进行 
合并 。 
建议 读者 就 这 一 问题 参考 更 多 的 论文 以 获取 更 多 
信息 。 参 考 文献 [41. 36] 中 就 控制 领域 所 面临 的 挑 
战 进 行 了 概述 。 关 于 网 络 移动 系统 的 基本 理论 已 在 后 


动 高 速 公 路 系统 ”“” 、 协 作 机 器 人 编队 …” 和 操 
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的 控制 “中 进行 了 探讨 。 我 们 下 一 节 的 目标 是 探 
讨 通信 、 感 知 和 控制 之 间 的 联系 。 


41.5 控制 通信 


通信 网 络 允 许 互 不 相连 的 个 体 之 间 交 换 信息 ， 
少 当 机 器 人 组 协同 行动 时 ， 人 允许 机 器 人 之 间 交 换 状 态 


pil 


机 器 人 网 络 S 由 W 个 智能 体 组 成 ， 他 们 拥有 
通过 智能 体 的 自然 分 布 来 定义 的 遥感 图 和 通信 图 。 
ERE (AUB Arf PRI AOL) 是 由 一 副 地 图 E: x 


fae?! 。 在 更 高 层面 上 ， 机 器 人 可 以 根据 从 不 
同 机 器 人 处 获得 信息 所 产生 的 完整 地 图 来 执行 导航 和 
搜索 任务 。 
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在 多 个 车 辆 情形 下 对 通信 控制 的 使 用 已 经 在 
对 联机 车 辆 队 形 进行 研究 的 路 径 工程 ”1 中 实现 
了 。 人 们 对 编队 的 稳定 性 “*”“”、 编 队 队 形 的 收敛 
性 1 以 及 系统 的 整体 性 能 “等 方面 的 问题 非 
常 感 兴趣 。 系 统 性 能 是 直接 受 智能 体 之 间 的 相互 
联系 影响 的 。 除 了 对 稳定 性 有 影响 "”” ， 来 自 不 
同 智能 体 的 状态 反馈 信息 和 前 馈 信息 会 影响 多 机 
BEA BOSE BOR CAI RE A dS RUIT ile 
出 反应 的 速度 。 

此 外 ， 通 信 可 用 于 机 器 人 的 高 级 控制 和 规划 。 
人 们 对 使 用 静态 传感器 节点 作为 信 标 引导 机 器 人 
导航 有 极 大 的 兴趣 。 参 考 文献 [41.48] m, E 
了 用 移动 机 器 人 覆盖 和 探测 未 知 动 态 环境 的 问题 。 
在 全 局 信息 无 法 获得 的 假设 下 提出 了 一 种 算法 
( 既 不 是 地 图 信息 ， 也 不 是 全 球 定位 系统 (GPS) 
信息 ) 。 该 算法 部 署 了 无 线 电导 航 网 络 来 协助 机 器 
人 完成 覆盖 任务 ， 机 器 人 也 用 此 网 络 进行 导航 。 
部 署 的 网 络 除 了 完成 覆盖 任务 外 也 可 以 被 用 作 他 
用 (如 多 机 器 人 任务 分 配 )。 参 考 文献 [41.43] 
提出 了 一 个 基于 势 场 导航 的 类 似 想法 。 在 此 算法 
中 ， 和 危险 区 域 的 概念 被 纳入 导航 成 本 函数 中 。 近 
期 沿 着 这 一 思路 从 传感器 节点 获取 实验 数据 的 研 
究 工 作 见 参考 文献 [41.49], 

在 通信 功能 的 协调 控制 和 规划 中 (参见 参考 文 
献 [41.50]) ， 通 信 网 络 在 创建 信息 共享 表示 中 起 着 
要 作用 。 这 种 共享 表示 的 概念 对 协调 控制 算法 和 大 
量 的 设备 之 间 的 比例 是 很 重要 的 。 例 如 ， 在 参考 文献 
[41.41] 中 ， 卡 尔 曼 滤波 器 的 信息 表 是 用 来 推导 分 
散 估 计 和 融合 算法 的 框架 的 。 这 种 方法 适用 于 多 种 异 
质 的 地 面 和 空中 平台 后 3。 在 这 种 方法 中 ， 合 作 车 
辆 的 特性 和 身份 是 已 知 的 。 这 是 因为 每 个 车 辆 都 有 共 
同 的 表示 ， 它 们 由 确定 性 网 络 所 组 成 ， 包 括 有 关 目 标 
检测 的 可 能 性 信息 和 用 于 卡尔 曼 滤 波 器 "引信 息 形 
式 中 的 信息 向 量 矩 阵 对 。 通 过 改变 确定 性 网 络 和 向 
量 /和 矩阵 信息 ， 观 察 的 结果 可 以 通过 网 络 进行 传播 。 
这 使 得 每 个 车 辆 的 行动 选择 效用 函数 最 大 化 ， 这 是 来 
自 对 环境 中 的 特点 进行 检测 和 定位 的 车 载 传感器 的 联 
合 相 互信 息 增 益 。 

因而 简 言 之 ， 在 最 低 水 平 上 ， 通 信使 得 网 络 能 
够 进行 部 分 或 全 部 的 状态 反馈 ， 并 允许 智能 体 为 前 
馈 控 制 而 交换 信息 。 在 较 高 水 平 上 ， 智 能 体 可 以 共 
享 规 划 和 控制 信息 。 这 一 点 在 41.6 节 也 进行 了 讨 
论 ， 认 为 通信 网 络 使 得 以 网 络 为 中 心 的 方法 适用 于 
感知 。 
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41.6 感知 通信 

随 着 个 体 机 器 人 有 传感器 和 通过 整合 传感器 信息 
建立 地 图 和 模型 的 能 力 ， 网 络 化 机 器 人 可 以 交换 来 自 
其 他 机 器 人 的 信息 、 数 据 、 图 片 和 模型 。 难 题 是 在 任 
务 中 利用 感知 通信 ， 例 如 分 布 式 绘制 地 图 时 的 延迟 、 
有 限 带 宽 和 破坏 现象 ， 这些 都 是 典型 的 通信 网 络 
特点 。 

分 布 式 定位 是 用 来 描述 状态 估计 中 通信 和 感知 的 
合并 术语 。 定 位 是 发 展 低 成 本 机 器 人 网 络 的 有 效 工 
具 ， 这 一 机 器 人 网 络 用 于 定位 认 知 应 用 和 普遍 存在 的 
AKS 。 定 位 信息 需要 记录 节点 的 分 布 并 使 连同 
节点 的 物理 位 置 测 得 的 价值 相互 联系 ， 在 测量 噪声 存 
在 的 情况 下 ， 分 布 式 计算 和 和 鲁 棒 性 是 实际 定位 算法 的 
关键 因素 ， 这 一 算法 会 对 大 规模 网 络 给 出 可 靠 的 
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分 散 式 定位 方法 可 以 分 为 两 大 类 : 依赖 于 锚 节 
点 本 土 化 的 算法 和 不 使 用 信 标 节点 的 算法 。 本 土 化 
可 以 用 节点 、 方 位 信息 或 两 者 兼 有 的 范围 信息 来 
计算 。 

参考 文献 [41.28] 中 依据 图 表 刚 度 理论 提 : 
网 络 定位 的 理论 基础 。 当 节点 有 完善 的 范围 信息 时 间 
题 就 得 到 了 解决 ， 它 表明 当 且 仅 当 网 络 底层 图 是 全 局 
刚性 时 ， 网 络 具 有 唯一 定位 。 人 参考 文 献 [41.52] 为 
网 络 定位 推导 出 了 克拉 莫 ， GER AE (CRLB)。 这 项 
工作 计算 了 理想 算法 的 预期 误差 特性 ， 并 且 将 此 误 
差 与 基于 多 点 算法 中 的 真实 误差 比较 ， 得 出 了 一 个 
重要 结论 ， 由 算法 引入 的 误差 与 评价 终端 到 终端 定 
位 精确 度 时 的 测量 误差 同等 重要 。 参考 文献 
[41.53] 展示 了 一 种 分 布 式 算法 ， 它 可 以 不 使 用 信 
标 并 保证 在 存在 节点 测量 噪声 情况 下 能 计算 出 正确 
的 定位 信息 。 该 算法 依赖 于 鲁 棒 的 四 边 形 理念 来 鲁 
棒 地 计算 节点 之 间 的 全 局 坐标 系 ， 并 且 支 持 移 动 节 
点 。 参 考 文献 [41.54] 讨论 了 这 一 被 动 跟 踪 扩展 
工作 。 参 考 文献 [41-55, 56] 包括 了 基于 定位 信 
息 传 播 的 定位 ， 这 一 定位 信息 来 自 于 以 连通 性 为 基 
础 的 已 知 参考 节点 。 参 考 文献 [41.57] 介绍 了 移 
动 辅助 定位 。 其 他 技术 应 用 了 使 用 多 点 定位 的 位 置 
HE Ge US 

参考 文献 [41.59, 60] 给 出 了 两 种 方法 ， 这 两 
种 方法 是 关于 移动 机 器 人 组 的 合作 性 相对 定位 。 既 不 
用 GPS 、 地 表 也 不 用 任何 形式 的 地 图 ， 相 反 地 ， 机 器 
人 直接 测量 处 于 相对 位 置 附近 的 机 器 人 并 且 将 此 信息 
传递 给 整个 团队 。 参 考 文献 [41.59] 指出 ， 每 一 个 
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机 器 人 使 用 带 有 滤波 器 的 贝 叶 斯 形式 来 独立 地 处 理 此 
信息 ， 并 来 对 其 他 机 器 人 位 置 以 自身 为 中 心 进行 估 
计 。 参 考 文献 [41.60] 中 用 极 大 似 然 估计 (MLE) 
和 数值 优化 达到 相似 的 结果 。 

一 个 关键 问题 是 为 大 量 机 器 人 和 传感器 建立 共 
同 表 现 来 批 处 理 这 些 计算 。 最 近 在 美国 国防 部 高 级 
研究 计划 局 (DARPA) 资助 的 分 布 式 机 器 人 软件 项 
A (SDR) 中 的 实验 ， 研 究 了 这 一 问题 。 这 些 实验 
的 目的 是 开发 和 演示 能 够 执行 具体 任务 的 多 机 器 人 
系统 。 这 需要 能 够 在 不 可 探测 的 建筑 里 部 署 大 量 的 
机 器 人 ， 绘 制 建筑 物 的 内 部 结构 ， 跟 踪 观 测 和 人 侵 者 
并 把 上 述 所 有 信息 传输 给 远程 操作 人 员 。 人 参考 文献 
[41. 19] 介绍 了 一 组 实验 的 报告 。 描 述 了 部 署 机 器 
人 的 分 层 策略 ， 其 中 高 性 能 的 机 器 人 能 形成 进入 和 
绘制 建筑 物 的 第 一 波 ， 随 后 的 第 二 波 是 为 人 侵 者 运 
用 结果 地 图 来 自动 部 署 和 监测 环境 。 这 两 种 方法 都 
广泛 地 依赖 于 运用 了 商业 802. 11b 的 无 线 技术 的 网 
络 机 器 人 。 这 一 任务 包括 建立 共同 表现 的 通信 和 感 
知 控制 。 

当 机 器 人 网 络 用 于 在 动态 环境 中 识别 、 定 位 、 
跟踪 目标 时 ， 另 外 一 系列 重要 的 问题 产生 了 。 岩 入 


识别 、 定 位 无 人 驾驶 飞行 器 (UAV) 可 以 用 来 覆盖 
大 范围 区 域 ， 搜 索 目 标 。 然 而 ，UAV 上 的 传感器 很 
明显 会 受到 地 面 上 目标 定位 准确 性 的 限制 。 另 一 方 
面 ， 地 面 机 器 人 可 以 准确 地 布置 以 定位 地 面目 标 ， 然 
而 却 不 能 快速 移动 ， 也 不 能 看 清 诸如 建筑 或 篇 爷 这 样 
的 障碍 。 在 参考 文献 [41.30] 中 ， 这 两 种 设备 的 协 
同 作用 被 用 来 创建 UAV 和 无 人 地 面 车 辆 (UGV) 之 
间 的 无 颖 网 络 。 正 如 在 41.5 节 谈 到 的 那样 ， 以 网 络 
中 心 搜索 定位 方法 的 关键 在 于 状态 信息 的 共同 呈现 ， 
在 这 种 情况 下 ， 这 一 方法 很 容易 扩展 到 大 量 的 UAV 
和 UGV， 并 且 对 于 个 体 平 台 的 特性 很 清晰 。 然 而 ， 
怎样 更 广泛 地 应 用 于 更 多 的 无 结构 信息 仍 是 未 来 需要 
研究 的 问题 。 


41.7 感知 控制 


网 络 移动 机 器 人 使 动态 环境 的 探索 与 三 维 信息 通 
过 分 布 式 主动 感知 得 到 恢复 成 为 可 能 “””。 因 为 节 
点 是 移动 的 ， 一 个 自然 问题 是 节点 应 该 如 何 摆 放 ， 以 
确保 多 节点 信息 的 成 功 整 合 ， 并 最 大 限度 地 提高 团队 
返回 的 估计 质量 ? 由 于 传输 和 处 理 数据 会 造成 一 定 花 


式 固 定 无 线 传 感 器 网 络 就 像 一 个 在 广阔 地 理 范 围 内 
的 虚拟 传感器 。 这 种 网 络 可 以 为 移动 机 器 人 提供 远 
程 定位 信息 。 机 器 人 网 络 允许 这 一 虚拟 传感器 根据 
外 部 刺激 来 移动 以 跟踪 移动 目标 。 事实 上 ,很 可 能 
将 这 一 情景 描述 为 有 机 器 人 传感器 网 络 的 追 逃 对 
REO 。 举 例 来 说 ， 南 加 州 大 学 的 特 尼 特 计划 解决 
的 是 分 层 网 络 架 构 的 网 络 基 元 和 抽象 问题 ， 并 且 机 
器 人 的 人 据 逃 对 策 是 目标 应 用 之 一 。 人 们 讨论 了 指导 
机 器 人 船 采 样 策略 的 算法 ， 这 种 算法 旨 在 模拟 和 定 
位 水 生 环境 中 的 感 兴趣 现象 (比如 热点 ) In, qs] 
络 信息 机 械 系 统 (NIMS) 项 目 专 注 于 事件 响 
应 中 和 场景 重 构 "， 中 移动 机 器 人 自 适 应 采样 的 
传感器 辅助 技术 。 

可 以 在 中 央 位 置 或 分 散 方式 下 处 理由 传感器 网 
络 节点 收集 的 信息 。 比 起 集中 处 理 ， 这 种 网 络 在 线 
数据 处 理 技术 更 能 充分 利用 网 络 交流 计算 资源 。 这 
也 使 网 络 可 以 估计 全 局 景观 感知 的 图 片 ， 这 些 图 片 
精确 且 是 最 新 的 ， 并且 该 系统 中 所 有 的 机 器 人 均 可 
以 利用 。 网 络 数 据 处 理 静 态 节 点 的 方法 包括 人 工 势 
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费 ， 考 虑 什么 样 的 传感器 的 读数 应 用 于 状态 估计 和 什 
么 信息 应 该 传达 给 系统 的 其 他 部 分 非常 重要 。 在 绝对 
意义 和 相对 意义 上 ， 由 网 络 计算 的 信息 的 质量 都 取决 
于 传感器 的 定位 ， 信 息 质量 还 取决 于 每 一 个 传感器 的 
噪声 特点 以 及 通信 网 络 。 

一 个 机 器 人 网 络 远 远 超出 了 一 个 固定 的 传感器 网 
络 ， 后 者 可 以 只 收集 在 固定 位 置 的 空间 数据 ， 例 如 ， 
当 一 个 事件 是 在 特定 的 位 置 被 发 现时 ， 指 挥 多 个 传 感 
器 向 事件 观测 位 置 传递 更 多 的 信息 是 有 可 能 的 (fh 
如 ， 更 高 分 辩 率 的 数据 或 更 高 的 采样 频率 ) 。 为 适当 
分 辨 率 采 样 重新 配置 节点 位 置 依赖 于 分 布 式 控制 
策略 。 

控制 移动 传感器 网 络 履 盖 范 围 已 经 有 了 很 多 策 
略 。 移 动感 应 智能 体 由 基于 信息 的 目标 函数 梯度 来 
控制 $1。 得 出 来 的 稳定 性 结果 不 需要 关注 网 络 配 
置 的 优化 ， 而 需要 提供 当地 保证 。 研 究 结果 的 主要 
部 分 描述 了 关于 已 知事 件 分 布 密度 函数 的 最 优 定位 
移动 传感器 网 络 的 分 散 控制 规律 ”“'“ 。 这 一 方法 
非常 有 利 ， 因 为 它 保证 网 络 (部 分 地 ) 能 够 将 关于 
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场 运算 、 梯 度 计算 、 粒 子 过 滤 、 贝 叶 斯 推理 和 信和 号 
处 理 。 这 些 算 法 已 经 被 发 展 为 计算 地 图 、 路 径 和 
Toig 4n 43 48,64] 3 

最 近 的 DARPA 展示 了 通信 网 络 如 何 有 效 地 应 用 
于 关于 异 质 机 器 人 的 感知 任务 “””。 合 作 研究 表明 ， 


覆盖 范围 问题 的 代价 函数 最 小 化 。 然 而 ， 控 制 策 略 
需要 每 个 智能 体 对 事件 分 布 密度 有 全 面 的 认识 ， 因 
而 , 它 对 感知 环境 反应 不 够 灵敏 。 参考 文献 
[41.68, 69] 概括 的 结果 是 ， 网 络 节点 需要 估计 而 
不 是 事先 知道 事件 分 布 密度 函数 。 局 部 (分散 ) Tu 
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制 规律 需要 每 个 智能 体 在 其 自身 位 置 上 能 够 测量 分 
布 密度 函数 的 值 和 梯度 。 传 感 器 网 络 中 这 一 结果 对 
它 的 感知 环境 很 敏感 ， 当 保持 或 寻求 一 个 近似 最 优 
感知 配置 。 另 外 ， 根 据 智能 体 的 Voronoi 区 域 顶点 ， 
分 布 密度 函数 估计 会 产生 一 个 控制 率 的 封闭 表达 式 。 
这 消除 了 在 多 项 式 域 中 每 个 时 间 步 长 对 函数 进行 数 
值 积分 的 需求 ， 从 而 使 得 每 一 个 智能 体 的 计算 费用 
显著 降低 。 对 于 未 知 分 布 的 事件 监测 的 其 他 工作 见 
参考 文献 [41. 33] Krause 等 人 "中 最 近 提 出 了 一 
种 方法 ， 这 种 方法 指出 在 安装 传感器 时 要 考虑 精确 
感知 和 通信 元 件 的 感知 质量 与 通信 成 本 两 个 方面 。 
他 们 使 用 一 种 假定 没有 确认 也 没有 失真 链接 的 时 间 
相关 性 的 链接 接受 率 的 参数 模型 。 

随 着 艺术 馆 警 报 设置 问题 的 出 现 ， 为 确定 传 感 
器 的 最 佳 配 置 来 覆盖 某 一 区 域 ， 人 们 已 经 做 出 了 多 
BESSA TP) 。 为 人 所 知 的 一 个 允许 使 用 移动 传 感 
器 的 变 体 是 看 守 者 巡逻 问题 。 这 些 方法 中 ， 传 感 器 
模型 是 抽象 的 ， 不 是 很 适合 真实 的 环境 和 照相 机 。 
分 布 式 几 何 优化 方法 所 人 也 被 应 用 于 移动 传感器 网 
络 重 构 。 一 类 相关 的 方法 是 理论 估计 优化 指标 的 使 
用 和 信息 过 滤器 的 应 用 ， 以 协调 整个 网 络 内 的 和 运动。 
还 有 其 他 使 用 分 布控 制 规律 的 分 布 优化 方法 ， 这 些 
方法 表明 它 可 以 优化 全 局 度量 ， 比 如 利用 势 场 或 者 
其 他 仅 基 于 局 部 交流 的 线性 控制 规律 “” 。 参 考 文 
WR [41.34, 75, 76] 研究 的 重点 是 带 摇 镜 头 、 倾 
斜 、 变 焦 功 能 的 相机 的 控制 。 参考 文 献 [41.75] 


过 网 络 传播 ? 并 且 关 于 信息 在 何 时 何 地 能 被 听 到 我 
们 可 以 说 些 什么 呢 ?” 如 果 我 们 知道 这 些 问 题 的 答案 ， 
这 也 许可 以 设计 控制 器 ， 以 实现 所 需 的 通信 网 络 的 
SE 

能 够 影响 网 络 性 能 的 简单 控制 策略 是 控制 机 器 人 
和 运动， 以 确保 信息 能 够 在 指定 的 节点 之 间 传 输 。 当 节 
点 超出 范围 时 ， 机 器 人 和 传感器 网 络 中 的 机 器 人 运动 
可 能 会 导致 网 络 分 区 。 然 而 ， 机 器 人 在 一 个 控制 方式 
上 的 移动 能 力 会 带 来 一 个 机 会 ， 这 个 机 会 可 以 通过 将 
机 器 人 转化 为 中 继 节 点 来 处 理 非 连 接 网 络 中 的 信息 路 
由 问题 。 此 处 的 核心 思想 是 使 机 器 人 拥有 未 知 目 的 地 
的 当前 信息 ， 以 便 修 正 它 的 轨迹 ， 达 到 传递 信息 的 目 
的 。 这 一 问题 已 被 表述 为 优化 问题 。 我 们 的 目标 是 尽 
量 减 少 必要 的 轨迹 修改 将 信息 发 送 到 目的 地 。 基 于 对 
机 器 人 有 用 的 信息 ， 已 经 提出 了 几 种 解决 方案 。 如 果 
机 器 人 的 轨迹 已 知 ， 路 径 规划 技术 可 以 用 于 计算 哪个 
机 器 人 移动 到 哪里 传递 了 什么 信息 ; WR ALA AB A 
迹 是 不 知道 的 ， 我 们 可 以 创建 分 布 式 生成 树 来 使 机 顺 
人 记录 彼此 的 轨迹 。 每 一 个 机 器 人 被 分 配 到 一 个 行动 
区 域 并 被 指定 一 个 父 生 成 树 。 当 机 器 人 离开 该 区 域 
时 ， 父 生成 树 被 告知 。 当 机 器 人 移动 得 太 远 时 ， 生 成 
树 被 修改 。 

在 合适 的 网 络 通信 模型 下 ， 移 动机 器 人 可 以 
用 来 创建 期 望 的 网 络 拓扑 结构 。 如 果 机 器 人 被 用 
做 在 环境 中 安放 节点 〈 或 传感器 节点 由 机 器 人 自 
Se) 以 建立 网 络 ， 这 个 问题 被 称 为 部 署 。 它 


中 提出 的 方法 是 自动 地 在 其 全 变焦 范围 内 校准 云 台 
变焦 相机 并 建立 高 分 辨 率 的 全 景 。 在 参考 文献 
[41.34] 中 ,摄像 机 不 断 移动 并 采用 分 解 图 来 跟踪 
观测 目标 。 参 考 文献 [41.77] 中 的 最 新 算法 显著 
地 改善 了 7 上述 情况 ， 这 一 算法 通过 定位 摄像 机 来 优 
化 网 络 ， 在 目标 出 现 后 使 网 络 更 适 于 观测 和 分 类 目 
标 。 云 台 变焦 摄像 机 允许 建立 更 灵活 的 可 视 系 统 而 
不 是 静态 摄像 机 。 


41.8 通信 控制 


在 41.5 节 中 ,我 们 简要 讨论 了 使 用 通信 网 络 来 
合成 和 改善 控制 器 设计 的 益处 。 相 反 地 ， 机 器 人 的 
行动 影响 了 网 络 以 及 网 络 中 的 数据 传输 。 这 产生 了 
很 多 挑战 。 如 果 个 体 机 器 人 的 控制 器 是 已 知 的 ， 我 
们 能 够 为 网 络 通信 提供 保证 吗 ? 我 们 能 在 存在 机 器 
人 运动 的 情况 下 开发 强大 的 路 由 信息 和 网 络 算法 吗 ? 
另 一 个 挑战 是 信息 如 何在 这 些 网 络 中 传播 和 扩散 。 


可 以 控制 各 个 节点 的 协议 来 保证 能 够 维持 指定 的 
拓扑 结构 ”1 。 它 也 可 以 重新 定位 节点 以 达到 改 
变 网 络 拓扑 结构 的 明确 目的 一 一 即 所 谓 的 拓扑 结 
构 控 制 问题 。 

一 种 移动 机 器 人 组 部 署 的 分 布 式 算法 被 虚拟 信息 
素 这 一 概念 描述 为 : 从 一 个 机 器 人 到 另 一 个 机 器 人 的 
局 部 信息 。 这 些 信 息 被 用 来 产生 气体 膨胀 或 者 引导 增 
长 的 部 署 模型 。 基 于 人 工 势 场 的 相似 算法 在 参考 文献 
[41.79, 80] 中 有 描述 ， 参 考 文献 [41.80] 包含 一 
个 连通 性 限制 。 在 参考 文献 [41. 32] 中 给 出 了 移动 
传感器 网 络 的 增 量 分 布 算法 。 节 点 一 度 被 部 署 在 未 知 
环境 里 ， 并 且 每 个 节点 利用 先前 布置 的 节点 所 传递 的 
信息 来 决定 它 的 部 署 位 置 。 这 一 算法 旨 在 保证 节点 能 
保留 与 其 他 节点 的 视线 范围 的 同时 将 网 络 覆 盖 范 围 
大 化 。 

大 多 数 网 络 拓扑 控制 工作 已 经 处 理 了 失去 控制 的 
部 署 ， 这 不 包括 单一 节点 位 置 的 明确 控制 。 主 要 机 制 
提倡 的 是 功率 控制 和 睡眠 协议 。 这 些 方法 包括 修改 已 


最 


如 果 机 器 人 在 给 定 的 控制 模型 下 运动 ， 信 息 如 何 通 


存在 的 连接 良好 的 通信 图 ， 以 便 在 保证 合成 的 子 图 能 
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够 保持 连接 的 同时 节省 电力 。 假 设 当 所 有 的 节点 在 最 
大 功率 情况 下 运转 时 网 络 是 连接 的 ， 功 率 控制 的 目的 
在 于 使 网 络 在 消耗 最 小 功率 情况 下 仍然 保持 连通 


的 任务 提供 了 巨大 潜力 。 实 际 上 ， 这 一 范例 对 诸如 环 
境 监 测 、 监 督 、 侦 查 以 及 人 民 安 全 和 防御 之 类 的 任务 
是 非常 关键 的 。 然 而 ， 要 想 实现 网 络 化 机 器 人 这 一 构 


性 小。 假设 网 络 高 度 发 展 ， 睡 虐 协 议 旨 在 激活 最 
小 的 节点 子 集 来 保持 连通 并 实现 其 他 所 需 指标 |。 
与 此 相反 ， 当 节点 的 位 置 可 以 修改 时 ， 控 制 部 署 是 可 
行 的 。 基 于 两 个 原因 ， 这 一 部 署 非常 有 趣 。 首 先 ， 有 
无 线 通信 的 网 络 拓扑 与 邻近 关系 以 及 节点 的 位 置 直 接 
相关 。 第 二 ， 有 越 来 越 多 的 证 据 表明 ， 大 量 的 部 署 很 
有 可 能 涉及 细致 的 、 非 随机 的 节点 位 置 。 节 点 位 置 由 
节点 自身 或 者 外 部 智能 体 控制 。 这 样 的 网 络 为 拓扑 控 
制 呈现 了 一 个 不 同 的 且 有 趣 的 场景 ， 因 为 它 可 能 利用 
行动 控制 和 节点 位 置 来 建立 有 效 的 拓扑。 参考 文献 
[41.83] 中 给 出 了 一 个 运用 移动 性 的 局 部 的 且 完 全 
分 散 的 拓扑 控制 技术 。 

网 络 机 器 人 的 一 个 重要 应 用 是 监测 和 监督 ， 机 
器 人 在 覆盖 区 域 的 同时 保持 通信 范围 很 重要 |。 
探测 环境 和 适应 性 睡眠 协议 (PEAS) 是 最 早 的 尝试 
之 一 ， 目 的 在 于 解决 通信 连接 和 运用 启发 式 算 法 来 
同步 感知 覆盖 范围 下。Wang 等 人 提出 了 一 
种 新 的 覆盖 配置 协议 (CCP) 来 创立 一 种 方法 ， 这 
种 方法 能 够 同步 优化 覆盖 和 连通 性 的 同时 将 进入 睡 
卢 模 式 时 的 节点 数量 最 大 化 。 此 外 ， 他 们 还 确定 了 
连通 性 覆盖 范围 问题 的 三 个 不 同 的 级 别 ， 这 些 问 题 
与 无 线 电 比 例 和 感知 范围 有 关 ， 并 确认 其 中 的 前 者 
的 关键 比例 范围 是 后 者 的 两 倍 。Zhang 和 Hou 证 明 ， 
如 果 通 信 范 围 至 少 是 感应 范围 的 两 倍 ， 凸 形 区 域 的 
完全 禾 盖 保证 网 络 通 信和 连通 性 ， 然 后 将 这 一 定理 用 
作 当 地 密度 控制 算法 的 基础 下 中。 这 是 随后 被 概括 
以 表明 通信 距离 是 感应 距离 的 两 倍 这 一 情况 是 充分 
的 并且， 如果 原始 网 络 拓扑 是 连通 着 的 话 ， 这 一 
情况 是 为 了 保证 意味 着 节点 间 的 通信 连通 性 完全 禾 
盖 保护 的 最 低下 限 |。 

总 之 ， 如 果 通 信和 网 络 的 状态 和 理想 状态 对 每 个 智 
能 体 来 说 是 已 知 的 ， 它 应 该 有 可 能 合成 移动 智能 体 的 
分 散 式 控 制 器 来 实现 所 需 的 网 络 特性 。 然 而 ， 全 局 状 
态 下 的 假设 显然 是 不 合理 的 。 此 外 ， 优 化 网 络 特性 期 
望 运动 会 与 被 要 求 来 完成 期 望 任务 的 运动 冲突 。 然 
而 ， 正 如 上 面 简短 讨论 说 明 的 那样 ， 有 许多 有 趣 的 研 
究 ， 这 些 研究 指向 这 一 极其 丰富 的 研究 领域 中 对 今后 
工作 非常 有 前 景 的 方向 。 


4.9 结论 与 扩展 阅读 


网 络 机 器 人 这 一 范例 为 完成 个 体 机 器 人 不 能 完成 


想 还 存在 许多 科学 挑战 。 这 里 总 结 了 主要 的 重要 
挑战 。 

技术 升级 上 的 挑战 : 我 们 目前 还 没有 方法 创建 一 
个 自我 管理 的 、 并 且 强 大 到 可 以 用 完全 分 散 的 控制 器 
Dudes re. dept aee 
复 的 机 器 人 网 络 。 这 需要 对 控制 、 感 知 和 通信 共同 点 
进行 基础 研究 。 

在 现实 世界 中 执行 实际 任务 : 目前 我 们 大 部 
分 应 用 的 着 重点 从 静态 传感器 系统 转向 动态 传 感 
器 系统 ， 就 这 点 而 论 ， 动 态 传感器 系统 是 可 以 获 
取 或 处 理 信 息 的 ， 要 创建 能 够 在 现实 世界 中 执行 
实际 任务 的 强大 机 器 人 网 络 ， 我 们 还 要 做 更 多 的 
努力 。 

以 网 络 中 心 控 制 监测 的 人 机 交互 : 过 去 十 年 的 进 
步 使 得 人 们 可 以 用 成 千 上 万 的 电脑 在 网 上 交流 。 为 达 
到 控制 和 监测 这 一 目的 ， 开 发 类 似 以 网 络 为 中 心 的 交 
流 方法 很 有 必要 。 

最 后 一 个 主要 挑战 是 创建 主动 的 、 可 预测 人 类 
需要 及 命令 而 不 是 回复 或 传递 人 类 命令 的 机 器 人 
网 络 。 

尽管 我 们 面临 很 多 挑战 ， 我 们 不 能 和 否认 网 络 机 咒 
人 具有 巨大 的 潜力 。 本 章 及 第 4 篇 (第 31 章 ) 和 第 
5 篇 (第 40 章 ) 的 相关 章节 表明 ， 研 究 机 构 正 在 取 
得 稳健 的 进步 并 应 对 前 方 的 挑战 。 

本 章 的 参考 文献 包括 所 列 具 体 研 究 课 题 的 许多 
要 点 ， 为 了 对 网 络 机 器 人 有 更 好 更 深入 的 了 解 ， 读 
者 可 参照 参考 文献 [41.5, 6, 19, 26, 29, 50, 
64, 71] &, 
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